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1. SIMPLIFIED MODELS OF THE ANNULAR 
SUSPENSION AND POINTING SYSTEM (ASPS) 

1.1 Introduction [13 

The Annular Suspension and Pointing System (ASPS) is a payload auxiliary 
pointing device of the Space Shuttle. The ASPS is -comprised of two major 
subassemblies, a vernier and a coarse pointing subsystem. 

The experiment is attached to a mounting plate/rim combination which Is 
suspended on magnetic bearing/actuators (MBA's) strategically located about the 
rim. Fine pointing is achieved by "gimbal 1 ing" the plate/rim within the MBA gaps. 
Control about the experiment 1 ine-of-sight is obtained through the use of a non- 
contacting" rim drive and positioning torquer. All sensors used to close the servo 
loops on the vernier system are noncontacting elements. Therefore, the experiment 
is a free-flyer constrained only by the magnetic forces generated by the control 
loops. 

The configuration of the ASPS is shown in Fig. 1-1. The payload/plate/rim 
combination is mounted on a set of coarse gimbals; an elevation and a lateral 
coarse gimbal, which provide the slewing and coarse pointing capability of the 
system. The pointing system concept is unique in that the vernier and coarse 
pointing subsystem are separate entities. This approach allows for sub-arcsecond 
pointing of the payload at any coarse gimbal position. 

The three functions provided by the ASPS are: (1) pointing the payload, 

(2) centering the payload in the magnetic actuator assembly, and (3) tracking 
the payload mounting plate and shuttle ^notions by the coarse gimbals. Rate and 
position errors sensed by gyros and celestial sensors located on the payload are 
processed by a controller which subsequently commands appropriate actuator force 
to point the payload. Proximeter sensors associated with the actuator clusters' 
detect the payload translation errors which are subsequently processed by the 
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controller and used to ascertain the appropriate centering forces. 

Figure 1-2 shows the payload and its mounting surface which is controlled 
by the magnetic actuator assembly (MAA) . The cables shown are for the purpose 
of connecting electric power from the shuttle to the payload and the MAA on the 
pallet. 

1 .2 The Planar Model of the ASPS [2] 

In this section the equations of motion of a simplified planar model of the 
ASPS are derived. 

The small-angle, smal 1 -displacement model shown in Fig. 1 -3 is planar with 
four degrees of freedom and is composed of a mount, a gimbal assembly (elevation), 
a pallet with magnetic actuators, and a payload. The pallet has one rotational 
degree of freedom relative to the mount, and the payload has two translational 
and one rotational degrees of freedom relative to the pallet. 

Let the four degrees of freedom be 

<j>j = attitude degree of freedom of the pallet relative to the mount 

(j >2 = attitude degree of freedom of the payload relative to the pallet 

Xj = translation degree of freedom of the payload relative to the pallet 

Zj = translation degree of freedom of the payload relative to the pallet 

The following coordinates are defined: 

(x 0 ,z 0 ) = inertial axes 

(xg,Zg) = inertial axes rotated through an angle of relative to the 
(xq,Zq) axes, (<j)^ is defined as the gimbal angle). 

(x m ,z m ) = axes fixed at the pallet center of gravity (CG) 

(Xj,Z|) = static axes of the payload 

(x.,z.) = axes fixed at the payload center of gravity (CG) 

(Xj,Zj) = axes fixed at the center of the base of the payload. 



h 



Figure 1*3. Planar ASPS model. 



5 


The following system parameters are defined: 

M. = mass of the payload = 600 Kg 

M = mass of the pallet = 82 Kg 
m r 

2 

J = inertia of the pallet about its mass center = 3.1 Kg-m 
m 

2 

J. = inertia of the payload about its mass center = 503 Kg-m 
L = radius of the payload = 0.406 m 

= distance from the gimbal to the pallet CG = 0.2064 m 

= distance from the pallet center to the payload CG = 1.486 m 

r = distance from the gimbal assembly to the pallet center - 0.47 m 

d 

r^ = distance from the gimbal assembly to the payload CG = 1.956 m 

Tq = distance from the mount base to the gimbal assembly = 0.75 m 

Since the payload is suspended with respect to the pallet, there are many 
ways of fixing its coordinates for the motion of rotation. In other words, the 


angle can be defined in a number of ways. Figure 1-4 illustrates the small - 
angle rotation of the pallet and the payload with 4>2 measured as the angle between 
the coordinate axes of (X|,Zj) and (xj,Zj). This configuration is defined as 
Model 1 of the ASPS. Figure 1-5 illustrates the model of the ASPS with <p^ 
measured at the CG of the payload; i.e., between the axes of (Xj,Zj) and (x.,z.). 

The following coordinate transformations are identified: 


Transformation from the static pallet axes to the mount axes: 


cos$ M -sincj)^ 


Transformation from the dynamic pallet axes to the static pallet axis: 



(1~2) 
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Figure 1-4. Planar ASPS Model 1. 
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Figure 1-5. Planar ASPS Model 2. 
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Transformation from the dynamic payload axes to the dynamic pallet axes: 


T 2 ~ 


cos< f > 2 

-sin<|> 2 


-i -t~ 

s i n $2 

cos (p 2 


CvJ 


(1-3) 


The force vectors applied to the payload by the magnetic actuator assembly 
are defined as: 


F 1 = 


F 2 ~ 


The 


f l 

f. 


= magnetic force applied at the positive x^ displacement (1-4) 


= magnetic force applied at the negative x^ displacement (1-5) 


forces Fj and are illustrated as shown in Fig. 1-5. 


The torque applied by the gimbal assembly is designated as T , as shown in 
Fig. -5. 

The following vector distances are defined for the pallet and the payload'. 

R^ = vector distance from the gimbal assembly to the payload point of 
appl ication of F| 

R 2 = vector distance from the gimbal assembly to the payload point of 
appl ication of F^ 

R^ = vector distance from the gimbal assembly to the pallet point of 
appl i cation of 

R^ - vector distance from the gimbal assembly to the pallet point of 
appl ication of F 2 - 
Equations of Motion of Model 1 

Using the degrees of freedom defined in the preceding sections, the kinetic 
energy of the system in Fig. 1-4 is 

T = K.E. = ifi'M R + ^RlM.R. + ^-J <|>2 + ij.(<j>. + cL) 2 (1-6) 

2 m m m 2 t i i 2 ml 2 i 1 


where the primes denote the transpose of a matrix, and 
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R = <f>, 

m Q 1 


<P 7 + 4>, 

o o 


0 - 8 ) 


Substitution of Eqs. (.1-7) and ( 1 —8) into Eq. (]-6) gives 

T - K - E - “ + ivf + 0 (i l - Ol - L b*2 )2 + ktf + + V 2 

0-9) 


Let the spring force applied to the system payload due to the cable be 


designated as t— — r 

f (x.) 
sx I 

f = (1-1 

f ( 2 . ) 

_ SZ I 

and the spring torque applied to the payload due to the cable be T (4> 2 ) , The 
spring torque applied to the pallet due to the cable is denoted as T 

The relation between the force F and the potential of the system, U, is 


Thus, 


where = constant. 


F - -VU 


U = U Q - F*dx 


The potential energy of Model 1 is 


, f 2 f z \ f x | 

U = U Q - { (f 1 - f^Xj + (f 2 + + j T s (q>)dcj) + f sz (z)dz + f sj ,(x)dx 


f<P] f<l>i 

(f, - f 2 )L(j> 2 + [ T (<j>)d<f> + T 
J 4 c 0 J 0 F 


(<f>) dtf) 


The Lag rang! an Is defined as 


«£ = K.E. - U 


(1-14) 


Then from Eqs. ( 1—9) and 0“13)> we get 
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*- 5Va+l + + IV*! ' r b*i - V 2 )2 + + + ^> 2 


+ ( f ] “ V*, + ^ + F ^ Z « + 


+ (f^ “ f 2 ) L( l ) 2 + 


2 3' 1 

r*i 


•4> 2 f z | 

" T (<j> ) d<j> + f (z)dz + 

0 s J 0 52 


2¥1 2 i Y 1 Y 2' 

z, t x . 


0 
r4>i 


‘1 


o 


f (x)dx 
sx 


T (4>)d4» + T (<j>)# - U n 

^ A P ^ 


(1-15) 


The Lagrange equation of motion is 


3jt _ _d_ 

[3 

3x. dt 

i 



fc Q 


= 1,2, 3, 4 


where x^ = Xj , x^ = Z| , x^ = <f>^ and x^ = <j> 2 ' 
For i = 1 , we have 

dt 


3x, 


- f, - fi + f (x.) 

1 H SX V 1 


(1-16) 


(1-17) 


3x j = M i ( *I ’ r b<h " L bh ] 


Thus, 


j£ _ 

3x j 

3x j dt 


l»*| 


= -M, X| + + M.L b * 2 + (f, 


V + f sx ( V = ° 
0 - 18 ) 


For i = 2, we have 


ifr-^ + vwv 


dt 

3z . 


H. z. 

i t 


Then, 


3& _ XfL- 

3z, dt 3z 


V 


= "Vi + (f 2 + V + f S2 (z l ) * 0 


( 1 - 19 ) 


For i = 3, we have 

3 jt 

3<t> 1 

dt 


dq> 


" T c (< h> + T p ( 'h> 

= M » L az+1 + M i ( ‘Vl + ’Vh + r b L b*2 ) + Vl + Vl + J i*2 
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d fSeC. 


d t [34* 


MV + W + M T r K X . 
cl p 1 i b 1 


(j + J . + M 
m i m a i b 1 


- (J. + MjL b r b )^ 2 = 0 (1-20) 


For i = A, we have 


(f 3 - f 2 )L 


-M.L.x. + r, L,M.<{>, + M.L,d> + J.cf). + J.ilu 
i b I b b r Y i i b T 2 r 1 i Y 2 

dt SIT = W + ^ f 3 " V L + M i L b X i 


- ( M i L b r b + J iM ' M L b + V^ = 


( 1 - 21 ) 


The Lagrange equations in Eqs. (]-38), (1-19), (1-20) and (1-21) are written 
in matrix form as follows: 


-M.r. 

i b 


-M.L, 
l b 


WW 


0 J +J.+H L Z +M.r Z 
m i m a i b 


0 J.+M.L.r. 

i i b b 


J.+M.L,r 4>, 

i i b b 1 

J.+M.L* L 

lib r 2 


WW 

T c W l )+T p ( +l ) 

(f 3 -f 2 )L+T s («t» 2 ) 


(1-22) 


Equations of Motion of Model 2 

For the ASPS system Model 2, the kinetic energy of the system is still 
given by Eq. (1-6), and is as defined in Eq. (1-7), except that 



.Substitution of Eqs. (l -7) and (l -23) into Eq. (l -6) gives 


(1-23) 


„ 1,, |2:2,1 )U| *2.1 U /* •\2.1,:2 1 1 i /‘ . • N 2 
K - E - ‘ iWh + 2 V 1 + 2^1 Cx I ‘ r bV + * 2 J i ^ 1 + *2> 


(1 - 2k ) 


The potent i a 1„ energy of the Model 2 is 
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U = U 0 “ {(f I ' V x l + j 0 ‘ f sx (x)dx + (f 2 + f 3 )z i + j 0 ' f sz (z)dz + . 
+ j^ 1 T c (4>)d4» + T p (4>)d<j> + (f 3 - f 2 )L4> 2 + (f 1 - f A )L fa <}) 2 > 


ft 2 


r s (<p)d<p 


(1-25) 


The Lagrang ian at i s given by 


i-K.E. +* 2 > 


2 . 1-2 


+ < f l “ V 


A 


T 


-.♦c 

(4>) d<f> + | 


f (x)dx + (f + f )z. + 

0 sx 2 3 1 J 0 


f (z)dz 
sz 


'0 '0 

+ ( f 1 - W *2 " U > 


T c (^)d4> + 


4 


T p (4>) d(j> + {(f 3 - f 2 )L 


(1 - 26 ) 


The Lagrange equation of motion is given by Eq. (1-16). 

Following the same procedure as for Model 1, the Lagrange equations of 
Model 2 are derived by use of Eqs. (1-16) and (1-26), and the result is 


M. 

i 

0 

-M.r, 
t b 

0 


x r 


f,-fi+f (x.) 
1 A sx i 

0 

M. 

0 

0 


z, 


f_+f_+f (z.) 


i 




! 

_ 

2 3 sz i 

-M.r. 

I b 

0 

J +J.+M L 2 +M.r 2 
m i m a i b 

J. 

i 


+i 


yy+yv 

0 

0 

J. 

i 

J. 

i 


A 


(f 3 -f 2 )L+(f ] -f 4 )L b +T s (* 2 ) 


(1-27) 

in the analysis conducted in the ensuing sections the equations of motions 
of Model 2 wi 1 1 be used. One reason for this selection is that the mass matrix 
of Eq. (1-27) is simpler than that of Model 1 in Eq. (l,-22). Another reason for 
using Model 2 is that the model uses the center of gravity of the payload as 
the reference point of rotation, which is more logical. 

Substitution of the system parameters into Eq. (] -27) , we have 
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600 . 

0 

-U 73-6 

0 

0 

600 

0 

0 

1173-6 

0 

2805.15 

503 

0 

0 

503 

503 


+1 


WWV 

Wz 12 ! 1 


T c<*l>- T pt*l) 

( f 3 -f 2 L+(f 1 - f i} )L b +T s ((i) 2 ) 


0-28) 


1 j 3 Control of the Zj Dynamics of the Payload 

Equation { T-28) indicates that the z^ dynamics of the ASPS are not coupled 
to the other three degrees of freedom. The Zj dynamics are described by 

M.Zj = f 2 + f 3 + f sz (z,) ( 1 “29) 

The magnetic actuator forces f 2 + are controlled by feeding back the 
variables Z| and Zj. The control equation is 

f 2 +f j‘Vl'Vl <'-3°) 

where K = 37-861 N/m and K = 211.01 N/m/sec. 

P r 

Substitution of Eq. ( 1— 30) into Eq . (l-29), we have 

"i Wi ’ Vi * f «W 

Figure 1-6 shows the state diagram of the Zj dynamics of the ASPS with the 
continuous-data position-plus-rate controller. The notation N (z^) in the 
state diagram represents the functional relation of the wire cable which is 
attached to the center of the payload mounting surface. 

if the wire cable Is modelling by a linear spring, N (z.) is simply a 


sz 


constant, -K (N/m); that is. 


f (z.) = -K z, 
sz I si 

A nonlinear spring characteristic for N sz (zj) is shown in Fig. 1-7 . 


(1-32) 


However, since the mass of the payload is 600 Kg, and the spring constant is 
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only 0.35 N/m, the effect of the wire cable on the payload dynamics is not 
going to be substantial. 

The character i st ic equation of the continuous-data ASPS dynamic system 
with the linear wire cable spring characteristic is 

M.s 2 +Ks+K + K =0 ( 1-33) 

t r p s 1 

or 

600s 2 + 211.01s + 38.211 = 0 (1-34) 


The damping ratio of the system is 


? = 0.6968 (1-35) 

and the. undamped natural frequency is 

(D = 0.2524 rad/ sec ( 1 -36) 

n 

Analysis of the Digital ASPS z ^ Dynamics 

When the z^ dynamics of the ASPS are controlled by a digital position-plus- 
rate controller, the dynamic equation is 


M.Zj + K g Zj = f 2 ( t) + f ^ ( t) (1-37) 

where 

f 2 (t) + f 3 (t) = f 2 (kT) + f 3 ( kT) kT < t < (k+l)T ( 1'— 38) 

Then the control equation is 

f 2 (kT) + f 3 (kt) = -K z.(kT) - K r z.(kT) (1-39) 

Figure 1-8 shows the block diagram of the linear digital ASPS payload (z^ dynamics). 

Since all the system parameters are given, except the sampling period T, we 
shall study the maximum value of T for asymptotic stability. 

The characteristic equation of the digital system in Fig. l'-8 is 


A(z) = 1 



K /s' 
P 


+ m7 s ” 2 

I 


= 0 


(1-40) 
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The z-transforms in the last equation are evaluated as follows: 



(1-41) 


(1-42) 


Substitution of the last two equations into Eq. ( 1 -40) and simplifying, we have 



Stibsti tuting the system parameters into the last equation, yielding, 


z 2 + (1 4- 5597s i no- 0241 5T - 1 10..l688cos0.024l5T + 108.l688)z+ 1 - I4.5597sin0. 024151 
— 1 08 . 1 688cos 0.024 1 5T + 108.1688 = 0 (1-44) 

The roots of the last equation as a function of T are tabulated below and the' root 
locus diagram with T as a variable parameter is shown in Fig. 1-9. The critical 
value of T for asymptotic stability is approximately 5*7 sec. 


Sampling period 
T (sec) 

0.1 

0.5 

1 .0 

2.0 


Characteristic Equation 


2 

z 

2 

z 

2 

z 

2 

z 


1.96z + 0.965 = 0 
1.8l6z + 0.832 = 0 
1 .6l63z + 0.680 = 0 
1 .I686z + 0.4232 - 0 


Roots 

0.98 + j 0.069 
0.908 + j 0.0864 
0.808 + j 0 . 1 64 
0.584 + j0.286 
0.328 + jO.349 


3.0 


z 2 - 0.657z + 0.2298 = 0 




Figure 1-8. Block diagram of the linear digital ASPS 
payload z^ dynamics) . 
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4.0 

5.0 


5-7 
6 . Q 


z 2 - 0 . 082 1 z + 0.1 = 0 
z 2 + 0.556z + 0.0338 = 0 
z 2 + 1 .04z + 0.02533 = 0 
z 2 + 1.2572 + 0.03124 = 0 


0.041 + j 0.3135 
-0.4865, -0.0695 
-1 .01 , -0.025 
-1 .23, -0.0254 


The time responses of the digital system in Fig. l‘-8 for various sampling 
periods are shown in Fig. 1-10. The initial value of (t) is chosen to be 0.002 
m, since the static bearing gap of z^ is only O.OO76' m, so that the maximum 
constraints on the magnitude of z^ are +0.0038 m. The time responses in Fig. ]-10 
substantiates the root locus findings; when T = 6 sec, the closed-loop system 
is unstable. The time responses are quite good for T less than or equal to 3 
seconds . 

Effects of Quantization 

The block diagram of the digital ASPS payload Zj dynamics with the quantization 
effect is shown in Fig. 1-11. The input-output characteristics of the quantizer 
are illustrated in Fig. 1-12. The quantization level is denoted by h in meter. 

The effects of quantization can be classified into three catagories: (l) 
stable system with steady-state error, (2) unstable system with sustained oscilla- 
tion, and (3) unstable system with unbounded responses. The last case is possible 
since no saturation is assumed in the system model. 

The steady-state error due to quatization can be determined by using the 
least-upper bound method [33 and the condition of sustained oscillations is 
fpund by use of the discrete describing function. 

The "characteristic equation" of the system shown in Fig. 1-11 is written 


as 


A(z) = 1 + Q{z) (1 - z ) ^ 


, K + K /s 
1 r _p_ 


M. s 


i 1 + 


K s -2 
_ ft s 
M. 


= 0 


(l -45) 


where Q.(z) denotes the discrete describing function of the' quantizer. 
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Figure ] ~ 1 5 - G (z) plots for N - 6 and K g = 0.35, 3*5 and 35 N/m and critical region 
bounds of quantiser discrete describing function of ASPS payload z dynamics. 
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The z-transform of the last equation is evaluated using the results in Eqs. ('1-4 1 ) . 
and' (1-42). Equation (1-45) becomes 


A(z) = 1 + Q(z)G (z) = 0 
eq 


( 1 - 46 ) 



0 -47) 


For Kp = 37*861, — 211.01, M. = 600, and = 0*35, the last equati'on is 

simpl if ied to 

... 1 4. 5597s inO. 0241 5T-1 08. 1688cos0. 0241 5T+108.1 688) z - 1 4. 5597s inO. 0241 5T 


G (z) 
eq 


z - 2zcos0.024l5T + 1 


(1 -48) 


-108.l688cos0.024l5T + 108.1688 


Figure 1—13 shows the plots of G (z) for various periods of sustained 

eqr 

oscillations T c = NT, N = 2,3,4,... . The sampling period T varies along the 

curves. The square block in the figure which is centered at -1 represents the 

bounds on the critical regions of -1/Q(z) [4] . Theoretically, the intersects 

between the critical regions of — 1 /Q.(z) and G (z) represent conditions of 

eq 

self-sustained oscillations. it is clear from Fig. 1-13 that the system -shoul d 
be free from sustained oscillations for all sampling periods less than 2 seconds. 

Figure 1-14 illustrates the G^(z) plots for K g = 3.5 N/m, 10 times the 
nominal value. As pointed out earlier, since the mass of the payload is so large, 
the light spring effect of the wire cable does not materially affect the performance 
of the system. Figure 1-15 further illustrates that even with = 35 N/m, 100 
times the nominal value, the characteristics of the system for sampling periods 
less than 2 seconds are not significantly affected. 

The least-upper bound error analysis of the quantization effect is performed 
by referring to the system block diagram shown in Fig. ]~16. The quantizer is 
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Figure ]-l6. Block diagram of the digital ASPS payload z dynamics 
for the least-upper bound analysis of quantization effects. 
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C DMMDN ZjZBDT *T jfik-iMI t RM I MV 5 V 1 TFP.T < TEND < F'P.T I ME V 1 S > V i H 
COMMON RMI -.RLE «fikP »FiKP jTC'P jH-jAVIH * I V l H 1 V 1 HQ 

fiLL TIME INPUTS SHDULP EE INTEGRAL MULTIPLES" DF TINT. 


H— 4 4 

r:p=i . 
TZND=4O0 . 
TPRT=0.5 
TIMT»0.5E-3 
2 0=0 .. 00 £ 
shot 0=0. ‘ 

ERPOR=l .E-5 
RMI =6 00. 


RKP=37 . 86T . 
fiKR=£i 1 .01 
Hi: SM I =PKE-- RMI 
AMINV=1 ..-flf'II 



Figure 1-17- Computer program of the simulation of the ASPS payload z 
dynamics with quantization.. 
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50 

40 

Pij 

30 


100 


PRT I ME=-TPPT 
PPMT •*' 1 >=T 

PPMT'"£j=TEHD PAGE IS 

F'P.MT ( 3 .* =T I NT QF POOR QUALITY 

PRMT C 4 j =EPROR 

DERY < 1 > = 0 . 5 

HER VC £'- = 0.5 

NHIM=£ 

y>:i,<=zg 

Y':£>=2BnT0 

CHLL RKGS PRMT ? V ? BEP Y * HU IM , IHLF ,FCT ? DUTP ? fiUX > 

Er m- 

SUBROUT I HE PC TV TIME, V ? DERY 5 
DIMENSION Y<2 ■ jBERYCE':' 

COMMON 2 5 ZBDT , T ? Hi-: SM I ? RM I N V ? V 1 j TPRT , JEHU , PRT I ME? V i S ? V 1 H . 
COMMON RM I - Ah'S , RKP ? RKR ? TCP - H.jfiV 1 H ? I V 1 H ? V 1 HQ 
Z-Y 1 

zbot=y<£> 

Vl=fikP^Z+fir'-'R*ZBnT 
I F •' T I ME-T “■ 4 0 ? 5 0 ? 5 0 
T =T +T-I P 
V1S=V1 . 

7iH=vr: 

IF'-VIH .LT . 0 GO TO £0 
ft V i H= V 1 H.-‘ H '* + 0 .5 
GO TO 30 

ft V 1 H— ’! V 1 H "'H - 0 .5 

CONTINUE 

rviH=iFi:=:'-ftviH> 

VlHQ=FLORT f . IVIH.-^H 

Z£BOT=-RKSM I +-Z-RM I NV*V 1 HQ 

DERYCl>=ZBOT 

DERY < £ > =Z£DOT 

RETURN 

END 


CUBPOUT I NE DUTP T I ME » Y « BEP“i' ? IHLF NB I H - PRMT .■ 

B I MENS I ON Y '‘£7 ? DERY < £ > - PRMT e. 5 > 

COMMON Z ? ZBOT ? T ? RK CM I ? RM I NV ? V 1 ? TPPT , TEND , PPT I ME ? V 1 C , V 1 H 
COMMON fiM I ? RFS ? RKP , RKR ? TCP , H ? PV 1 H ? X V 1 H ? V 1 HQ 
I F >■' f TI ME-PPTI ME > . LT .TPRT > RETURN 
PRT I ME=PRT I ME+TPRT 

WRITE ('5 ? 1 00 •> TIME, VI , V1H , V1HQ , Vd > ,1 = 1 ,£!' iIHLF 


FORMAT < IX ?F5 .a? IX ?E1£ .5 ? IX ,E1£ .5 , IX ?E1£ .5 ? IX ,£-:iX ?E1£ ,5> ? IX ? I£; 


RETURN 


END 


Figure I~l/. Computer program of the simulation of the ASPS payload z 
dynamics with quantization. 
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replaced by the noise input wj th an amplitude of +h/2. 

The z-transform of the displacement z, due to the noise input is 


7 ( 7 ) - 0 - z ] ) 

Z l (z) Ali] 




1 


s^(l + K s“^/M.) 
i s i 


(+ h/2) 


z- — 1 


( 1-49). 


where A(z) is as given in Eq. ( 1-40} . 
In Eq. (1-49),. 


0 - 


>& 


1 


M . s 3 ( 1 + K s“ 2 /M.) 
i s r 


= 0 - z' 1 ) 


M.s(s + K /M.) 
i si 


1 


(z '+ 1) (1 - cos Jk /M? T) 
« s t 


Thus , 


Z 1 (z) 


K 2 I 

s z - 2zcosyK s /H. T + I 


r u + 'Xi - “s/iyff? t) (i?) (rN 


(1-50) 



The final steady-state value of z^ (kT) is given by 
lim z.(kT) = lim (1 - z ^ ) 

K 


* h 
- 2 


if ( 1 " cos m 7 t> ( i I 1 ' 

5 1 _ 

K K K + K 

2(1 + t£)( 1 - cos T) 5 p 


K 


(1-52) 


M. 


This result shows that the least-upper bound on the steady-state value of z^ (kT) 
due to quantization is inversely proportional to and K . 

For the given values of and K , we have 



0 - 53 ) 
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Jim z , ( kl) = 
k-*» 


38.21 1 


= + o.oi 30852 37 h 


.-4 


Thus, for a quantization level 'of 2 , the final error in z^ is +0.000817827 m. 


whereas it is +0 . 000051 1 1 4 m for a quantization level of 2 


-8 


1.4 Computer Simulation of the ASPS Payload z. Dynamics with Quantization 

In this section the z^ dynamics of the ASPS payload are simulated to study 
the effects of quantization. The computer program is given in Fig. 1-17. 

Figure 1-18 illustrates the time responses of z^ (t) of the ASPS payload with 
and without quantization, for the sampling period of T = 1 second. The initial 
value of Zj (t) was chosen to be 0.002 m. As predicted by the discrete describing 
function analysis, the system does not exhibit any sustained oscillations when 
T = 1 sec. ■ However, the nonzero quantization levels did produce steady-state 
errors in z^(t). The computer simulated results and the results obtained by 
the least-upper bound method are tabulated below for comparison. It is expected 
that the errors predicted by the least-upper bound method will be greater, since 
it is a worst-case study. 

Sampling Period T = 1 sec 

Quantization level h (m) z^ 'C 00 ) least-upper bound (m) z^ (°°) simulation (m) 

2 _Zf + 0.0008178 -0.000444 

2~ 8 +0.000051114 0.000036 

”8 

Figure 1 — 1 8 also shows that with the quantization level of 2 (8 bits), the 

time response of z^ (t) is very close to that of z^ (t) wi thout- quant ization , so 
that a larger word length seems unnecessary unless a smaller steady-state error 
is required. 

Figure 1-19 illustrates the time responses of z^(t) for T = 2 sec. For 

-4 • -8 

h = 2 , the error is -0.0003’ at t = 50 sec and still increasing. For h = 2 , 
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•the response actually exhibited a sustained oscillation with a peak-to-peak 
amplitude of 0.000066 m. As shown in Fig. 1-13, when T = 2 sec, the system is 
marginal in generating sustained oscillations. It should be noted that the 
digital computer is not the most suitable for simulating digital systems with 
quantizers, since the computer itself is a digital system with 'its own quanti- 
zation levels. However, the results obtained here are conclusive enough to 
indicate the quantization effects in the ASPS payload, and are useful in the 
selection of the sampling period and the quantization level. 

For sampling periods greater than 2 seconds, the computer simulation 
results showed that sustained oscillations always existed. 

1.5 Nonlinear Spring Effect of Wire Cable on the ASPS Payload Dynamics 

In the preceding sections the wire cable attached to the ASPS payload 
was modelled as a linear spring with a spring constant of K^ . In the z^ 
direction the spring constant is given as 0.35 N/m. It was shown in the 
last section that since the mass of the payload is so large (600 Kg), the 
light spring effect of the wire cable will not have a significant effect on 
the dynamics of the payload. This would be true whether the wire cable is 
modelled as a linear spring or a nonlinear spring. 

The block diagram of the digital ASPS payload z^ dynamics withthe 

nonlinear wire cable spring characteristic is shown in Fig. 1-20. As shown 

in Fig. 1-20, the nonlinear spring characteristic is defined by the parameters 

K and h r . 
s wf 

The simulation program for the system is given in Fig. T-21. Figures 
1-22 through 1-2^ show the time responses of z^ with the initial consition 
Zj (0) = 0.002 m and under the following three conditions: 

(a) linear spring, = 0.35 N/m 




Figure 1-20. Block diagram of the digital ASPS payload z ] dynamics 
with nonlinear wire cable characteristic. 

(b) non! inear spring, K g = 0.35 N/m, h^ = 0.00014 N 

(c) nonlinear spring, = 0.35 N/m, = 0.00028 N. 

Figure 1,-22 shows that for the scale chosen for z ] in that figure, the 

time responses of all the three cases are nearly identical. Figure -23 
shows the three responses between t = 10 sec and t = 100 sec with the Z| sea 
expanded. Figure ]-24 shows the three responses between t = 25 sec and t = 
100 sec with an even more expanded scale for Zj . Note that the use of the 
nonlinear spring model for the wire cable creates a nonzero steady-state 
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TYPE RSIM.F4 

DIMENSION FRMTC5) ,YC2) ,DERYC2> » AUX(8>2) 

EXTERNAL FCTjOUIP 

COMMON Z , ZDO I, T , AkSMI , AM1NV, VI , TPRT , TEND , Ak'S,AMT , NPR T ,IV1 
ALL .TIME INPUTS SHOULD EE INTEGRAL MULTIPLES OP TINT. 

OPEN < UNI T^6 , DEV JCE= ' DSK ' , FILE= 'FQR06 . DAT ' , ACCESS= ' SEQOUT ' ) 

rsp= 2 . 

H-2,#*-10 
1END-100. 

TPRT=0 . 5 
i £N T = 1 . E-2 
20=0,002 
ZDUT0=0 . 

AMI -600. 

AkS-0.35 
AKP— 37 • 861 
AKR=211.01 
AkSMJ ==AkS/AMI 
AM1NV=1 ./AMI 

z-zo 

7 DO r =ZDO TO 

f-o. 

NPR r=o 

PPM l 1 3)- TINT 
PRMT<4)-=0.001*Zo 
ULRYt L)-0.5 
DERY (2) =0. 5 
Ml. IM -2 

10 IFt ! .GE, TEND) CALL EXIT 

V1=AKP#Z+ARR*ZD0T 

F'K'H i a ) = r 

Phrtl T 1 2 ) =T+TSP 
T< 1 >=Z 
T ( 2 ) =ZDOT 

CALI. KkGS(F'RM T ■ Y > DERY , NDIM, IHLF , I- C i ,UU i P , AUX ) 

SO TO 10 
END 

SI UBROU TINE F C I < X • Y , DERY ) 

DIMENSION Y < 2 ) • DERY (21 

COMMON Z j ZDO T *T, AkSMI , AM1NV, VI , TPRT, TEND, AKS r AMI , NPRT , 1 VI 
DCRY<1)=Y(2) 

DERr(2)-=-FCRCECY< l)»Y(2> ) -AMINV*V1 

RETURN 

END 

ST IDROU TINE OU IP ( X » Y , DERY , 1HLF , NDIM, PRMT ) 

DIMENSION Y (2 ) » DERY < 2 ) » PRMT < 5 ) 

COMMON Z , ZDOT , T r AkSMI , AM IN V , VI , TPRT , TEND , AKS » AMI , NPRT , I VI 
IF (x ,GI . TEND) PRh T<5>=1 . 

T”X 

IF < X , LT , T PRTS!FLOA T (NPRT ) ) RETURN 
LIRT TE < 6 , 100 ) I! ILFr X , VI j < Y C l ) , I = 1 ,2) 

.00 FORMA T (IX, 12 »3X» 1PE10 . 4 , 1P3E1 1.3) 

2~Y < 1 ) 

Znor=Y(2> 

Ni 'RT-NPR r+1 
RE1 URN 
END 

FUNC T /.ON FORCE < X . XDOI > 

COMMON Z,ZDOr»T, AkSMI, AMINV, VI, TPRT, FEND, AKS, AMI, NPRT, IV1 
HWF -0.00028 
IF tXDU 01,2,3 

1 FORCE = (AKS#X-HWK/2. .VAMI 

GO TO 4 

2 FORCE = AkSMDKX 

•GO 10 4 

3 FORCE = (AkS*X-fHUF/2, )/AMI 

-1 RETURN 

END 


ORIGINAL PAGE IS 
OF POOR QUALITY 


Figure '1-21 . Computer simulation program of the ASPS payload z^ dynamics 
with nonlinear wire cable characteristic. 




Figure 1-22. Time responses of the digital ASPS payload z^ dynamics with nonlinear wire 
cable characteristic. 






Iff 


0,4- 


linear spring mode] 

nonlinear spring mode] with h .p => 0 . 000 1 4 N 

nonlinear spring model with h w p = 0.00028 N 


0 . 2 ' 


0 . 0 ' 


- 0 . 2 ' 


(sec) 


Figure 1—2.4 . Time responses of the digital ASPS payload Zj dynamics with nonlinear wire 
cable characteristic. 
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error for Zy Wi th 

-c 

with = 0.00028 N the steady-state error is 0.12x10 m. Since these 


h ^ =. 0.00014 N the steady-state error is 0.18x10 m, and 


errors are extremely small, it may be concluded again that the wire cable 


effect on the ASPS payload may be neglected whether a linear or a nonlinear 


spring model is used. 



II. CONTROLLER DESIGN FOR THE ANNULAR SUSPENSION 
AND POINTING SYSTEM (ASPS) 
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2.1 introduction 

In the preceding chapter the equations of motion of the ASPS with respect 
to the planar models of Figs. 1-4 and 1-5 have been derived. The Lagrange 
equations of the planar ASPS model 2 shown in Fig. 1-5 'have been selected for 
analysis and design of the system. These equations are repeated as follows: 


M. 

i 

0 -M. r, 

1 b 

0 


■■ 

X 1 

1 

f. - f, + f (x.) 
1 4 sx r 


0 

M. 0 

1 

0 


Z 1 


f 0 + f , + f (z, ) 
2 3 sz 1 


-M. r, 

1 b 

0 J +J.+M L 2 +M. r£ 
m 1 m a ! b 

J. 

1 


+ 1 


T c <*,> + T p 


0 

0 J. 

1 

J. 

i 


1 

S5 

. 

(f 3 - f 2 )L + (f, - 

f i,V T s« 2 >_ 


( 2 - 1 ) 

The last equation shows that the dynamics of the payload are decoupled 
from the other three degrees of freedom. The z^ dynamics have been thoroughly 
studied in Chapter 1, and both the analog and the digital controllers have been 
designed. The main objective of this chapter is to study the dynamics related 
to the Xj , <j>j and axes which are coupled. 

In the ensueing sections an analog controller for the control of the x^ , 

<j> j and (|) ^ dynamics is designed by pole-placement techniques. 

2.2 Analytical Model of the x^ , ^ and $2 Axes 

After eliminating the Zj dynamics, Eq. (2-1) is reduced to the following 

form: 

x, = a$| + b((f ] - f^),^ fg^Xj)) 

if] = CX ] - d(j >2 + e(T c (4>]) + Tp^j)) , (2-2) 

4*2 = -$] + f (( f 3 " ^ 2 )L + (f ] " V L b + W) 


where 
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a = r b = 1.956 



0.*il8A 

0.1793 

0.000356 


f = 1/J. = 0.001988 

in Eq. (2-2) f (x. ) denotes the linear spring force due to the wire 

SX i 

cable attached to the payload. 

For linear analysis, f (x.) is assumed to be directly proportional to 

SX 1 

x, ; i .e. , 

f (xi) “ -K x, (2-3) 

sx 1 s 1 



where K , = K 0 = 0.005 N/m. 
s I s2 

Figure 2-1 shows a block diagram of the ASPS dynamics of the x^ , d> ^ and 
<j >2 axes as modelled by Eq. (2-2). Note that the linear system is of the sixth 
order with three inputs. The input eT^ denotes the torque which is applied 
to the pallet by the gimbal assembly. The input f^ - represents the net 
magnetic forces applied at the base of the payload by the magnetic actuator 
assembly, and the input fL(f^ - f^) denotes similar magnetic forces due to the 

















magnetic actuator assembly. 


,'kO'- 


2.3 Design of An Analog Controller For the ASPS By Pole Placement 

In this section we shall design an analog controller for the ASPS to 
control the dynamics of the x^ , , and <j> 2 axes. As shown in Fig. 2-1 there 

are three inputs that can be used through the magnetic actuator assembly forces 
and the gimbal torque to control the attitudes of X| , <j>j and <j> 2 . 

Let us assume that the controls of the x^ , (j)j and <f> 2 dynamics of the ASPS 
can be achieved through state feedback. Specifically, we construct the three 
i nputs as fol lows : 


f 


1 



K. x, 
r 1 


( 2 - 6 ) 


T c = -K 1 /<f > ] dt - K 2 «£ 2 K 3 ^ (2-7) 

(f 3 ~ f 2 )L + (f } - f i( )L b = -K 4 /(p 2 dt - K 5 <J> 2 - K 6 <j> 2 (2-8) 


where K , , K 2 , K^, K.^ and are constant gains whose values are to 

be determined. 

The block diagram of the ASPS with state-variable feedbacks as defined i'n 
Eqs. (2-6), (2-7) and (2-8) ?.s shown in Fig. 2-2. 

In order to evaluate the characteristic equation of the closed-loop ASPS 
we represent the block diagram of Fig. 2-2 by the simplified signal flow graph 
in Fig. 2-3. 

The branch gains a, c and d in Fig. 2-3 have been defined previously. 

The loop gains used in Fig. 2-3 are defined as 

A 1 = -b(K r s _1 + (K p + K s )s“ 2 ) (2-9) 

A 2 - -e(K 3 s _1 + (K 2 + K s5 )s‘ 2 + KjS-"?). (2-10) 

A 3 = -f(K 6 s _1 + (K 5 + K s2 )s" 2 4- K 4 s“ 3 ) 


( 2 - 11 ) 























42 


The design objective is to determine the feedback gain constants K p} K^, 

Kj , Kg, K^, K^ and Kg such that the eigenvaiues of the closed-loop ASPS are 
at certain specified locations. 

The first step of the design problem is concerned with the determination of 
the characteristic equation of the closed-loop system. This is accomplished by 
applying the Mason's gain formula to the signal flow graph in Fig. 2~3. The 
result is 

A = 1 - Aj - A 2 - A^ - ca - d + A ] (A 2 -i- A^ + d) + acA^ + A £ Ag - A^Ag ~ 0 

(2-12) 

Substitution of the relations for A^ , A 2 and Ag into the last equation, and 
rearranging, we get 

a Q s + a-.s'' + a c s + a r s 3 + a,s + a.s^ + a_s + a.s + a n = 0 (2-13) 

o/o3A32iu 

where 

ag = 1 - ac - d 

= b(l - d)K r + eKg + f(l - ac) Kg 

ag = b(l - d)K p + b(l - d)K s + e(K 2 + K s] ) + f(Kg + K &2 ) + beK r K 3 + efKgKg 

+ bfK r Kg - acf(K 5 + K s2 ) 

a c = eK. + f(l - ac) K. + beK_(K + K ) + beK (K 0 + K , ) + efK,(K„ + K .) 

5 1 4 3 p s' r 2 sr 6 2 si 

+ ef K_ (K,. + K ’) + bfK £ (K + K ) + bfK (K c + K J + befK-K.K 
3 5 s2' 6' p s r y 5 s2 3 b r 

a k = be (K p + K g ) (K 2 + K gl ) + KjK.be + efK,Kg + ef(K 2 + K s] )(K 5 + K $2 ) 

+ efKgKg + bf(K + K s )(K 5 + K s2 ) + bfK^ + bef((K^ + K^KgKg + K p Kg (K £ + K g] ) 

+ K r K 3 (K 5 + K s2 )) 
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a 3 = beK ] (K p + K s ) + efK^Kg + K s2 ) + 6fK 2{ (K 2 + K^) + bfK 4 (K p + K g ) 

+ bef ( K r K l K 6 + K r (K 2 + K sl> <K S + K s2> + K r K 3 K i + (K p + W K 2 + K sl> 

+ < K p + K s>ty K s + K s 2 » 

a 2 = efKjK^ + bef((K p + + (K p + K g ) (K £ + K^MKg + K^} + (K p + 

+ K r K] ( K 5 + K s2 ) + K r K 4 (K 2 + K sl )j 
a, = bef (K| K^K^. + K 4 (K p + K g ) (K £ + K gl ) + K ] (K p + K g ) (K $ + K^)) 
a 0 = bef^K^fKp + K s ) 

!n these nine coefficients, the values of a, b, c, d, e, f, K j , K s2 and 

are known, and the values of K p , K r , Kj , K 2 , , K^, and Kg are to be 

determined for a given set of roots of Eq. (2-13). 

Let the desired roots of Eq. (2-13) be A,, A„ , A- , A., A_, A,, A., and A 0 . 

I 2 3 4 5 6 / o 

The condition for these roots to be solutions of Eq. (2-13) is 

8 8 

a ft II (s - A.) = l a. s' (2-14) 

°i=l i=0 ' 

Expanding the left-hand side of Eq. (2-l4), we have the equation, 

agS 8 + g 7 (A)s 7 + 9g(A) s6 + 9 5 U)s 5 + g^UJs^ + 9 g(A)s 3 + g 2 (A)s 2 + g ] (A)s“ 

8 

+ g 0 (A) = I a. s' (2-15) 

i=0 

where 

A. — (^"| » ^2 ’ 5 ^4* ^5» ^6 1 ^g) 

denotes the vector of eigenvalues, and g.(A) (i =0, 1, 2, . . . , 7) are known 
once A/ is given. In fact, it is simple to see that 


a . ( K , 

' P 5 


K r , K r K 2 , K 3 , K 4 , K 5 , 


K 6> " 


9j (A) 


( 2 - 16 ) 


for i = 0 , 1 , 2 , . . . , 7 . 



Define 


(2-17) 


u 3 = (f 3 " f 2 )L + (f l" f 4 )L 6 

Equations (2-17), (2-18) and (2-19) specify the three inputs to 
is an eighth-order system with the state equation 


(2-18) 

(2-19) 

the ASPS wh i ch 


X 1 


— 

0 

1 

0 

0 

0 

0 

0 

0 


X 1 


0 

0 

0 

X 2 


a 21 

0 

0 

a 24 

0 

0 

a 27 

0 


X 2 


b 21 

b 22 

b 23 

X 3 


0 

0 

0 

1 

0 

0 

0 

0 


x 3 


0 

0 

0 

x k ' 



0 

0 

0 

0 

1 

0 

0 

0 


x 4 

+ 

0 

0 

0 

Lf\ 

•X 


a 51 

0 

0 

a 5k 

0 

0 

a 57 

0 


x 5 


b 51 

b 52 

b 53 

x 6 


0 

0 

0 

0 

0 

0 

1 

0 


x 6 


0 

0 

0 

x 7 


0 

0 

0 

0 

0 

0 

0 

1 


X 7 


0 

0 

0 

1 

x • 

OD 

1 


a 8l 

0 

0 

a 8h 

0 

0 

a 87 

0 


X 8 


b 8l 

b 82 

b 83. 


where 


x 2 = x 

x 3 " /♦ I dt 

x i< * h 

x s = h 

x 6 = /* 2 dt 

x 7 * *1 

x 8 = *2 


(2-20) 


and the entries of the matrices of the state equation are determined by the 
open-loop ASPS. The numerical values of these elements are:. 


a 21 = -0.6120962971 



a lk = -0.0014844271 
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a 27 = 0 . 001 4844271 

a c . = -0.312026593 

a ^ = -0.0007589096 

a c , = 0.0007589096 
5/ 

a gl = 0.312026593 

a gi} = 0.0007589096 

a g7 = -0.0007688499 

b 21 = 0.58237^5791 

b 22 = 0.2968854358 

b 23 = -0.2968854358 

b 5] = 0.2968854358 

b $2 = 0.1517819201 

b__ = -0.1517819201 
53 

bgj = -0.2968854358 
b g2 = -0.1517819201 
bg 3 = 0.1703268144 

Equation (2-20) describes the system part of the block diagram of Fig. 2-4. 
!n order to use the state feedback to realize a controller, it is necessary that 
the system is completely controllable. The controllability of the ASPS is 
determined as follows: 

Let Eq. (2-20) be written as 

x(t) = Ax(t) + Bu_(t) 

The necessary and sufficient conditions for the system. to be controllable are 
that the matrix 


' U = (B AB a 2 b . . . a 7 b) 


(2-21) 




Figure 2-4. Block diagram of the ASPS dynamics and the design of the analog controller. 
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be of rank eight. in the matrix B, as shown in Eq . (2-20) , 
non-zero rows. The determinant of these three rows is 


det 


Thus, we have 
A1 so , the matrix 


AB = 


'21 

b 22 

b 23 

1 — _ 

b 

b „ 

51 

52 

- 53 

’81 

b 82 

cr 

00 

UJ 

Rank(B) = 

3 

b , 

b 

b 

21 

22 

2 : 

0 

0 

0 

0 

0 

0 

b , 

b_„ 

b 

51 

52 

5 : 

0 

0 

0 

0 

0 

0 

b 8l 

b 82 

b 8; 

0 

0 

0 

:o 1 umn s . 

These 


= 0 . 00000^6913 ?£ 0 


columns of B. Therefore, 


Rank(AB) = 3 

and 

Rank(B AB) = 6 
2 

Furthermore, in the matrix A B, we have 


there are three 


( 2 - 22 ) 


(2-23) 


(2-24) 


independent on the 
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a 2l b 21 +a 24 b 51 +a 27 b 8l a 21 b 22‘ ! * a 24 b 52 +a 27 b 82 a 2 ] b 23 +a 24 b 52 +a 27 b 33 


51 


52 


53 


A 2 B = 


a 51 b 21 +a 54 b 51 +a 57 b 8l a 51 b 22 +a 54 b 52 +a 57 b 82 a 51 b 23 +a 54 b 53 +a 57 b 83 


(2-25) 


’81 


'82 


83 


a 8l b 21 +a 84 b 51 +a 87 b 8l a 8? b 22 +a 84 b 52 +a 87 b 82 a 8l b 23 +a 84 b 53 +a 87 b 83 


2 

If the rank of A B is greater than or equal to two, the matrix U in Eq . 
(2-21) will have full rank. Consider the two following rows of AB: 

( b 51 b 52 b 53^ and ( b 8l b 82 b 83^ 

It is obvious that these are linearly independent. Therefore, 

Rank(A 2 B) > 2 

Also notice that the third and sixth rows of the matrices B and AB have all 

zero elements. Therefore, there are at least two linearly independent columns 
2 

in matrix A B which is also linearly independent of the columns of the matrix 
[B AB] . Thus, we have the conclusion that 

Rank(U) = 8 

and the full rank of matrix U implies the complete control lab! 1 i ty of the ASPS. 

With the controllability of the system estab i 1 i shed , it is now possible 
to select the eigenvalues of the closed-loop ASPS by using state feedback 
described in Eqs, (2-6), (2-7) and (2-8); i.e., 
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u. = -K x. - K x, 

1 pi r 1 

u 2 = " K l/^] dt " K 2^2 " K 3^1 (2-26) 

u 3 = -K k j $ 2 dt - K 5 £ 2 - K 6 $ 2 


The closed-loop control system can be described by 


x(t) = (A + BG)x(t) - Ax(t) (2-27) 
where the matrices A and B are as in Eq. (2-20), and G is the feedback gain 
matrix and is given by 


-K -K 
P r 


G = 


0 

0 


0 

0 


- K 1 - K 2 " K 3 


0 0 0 0 ' 
0 0 0 


(2-28) 


-k 4 “ K 5 - k 6 


It is the objective of the design problem to choose a set of feedback 
gains such that the roots of the characteristic equation are as specified. 
The roots must satisfy the following equation: 

det(-s! - A) = 0 


if a closed-loop system is to be designed such that it has a bandwidth of 
one Hertz, then the eigenvalues are chosen as 

A,, A 2 = -7.16 + J8.75 

A y X k = -42.16 + J72.67 

A 5 = -11.41 

A 6 = -109.15 

A 7 = -24.21 

Ag = -6.54 


In this case, the eigenvalues must satisfy the following equation: 
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8 

det(sl - A) = n (s - A.) (2-30) 

i = ] 1 

where Aj (i— 1,2, . . ,8) are specified in Eq. (2-29). 

After expansion of both sides of Eq. (2-30), the coefficients corresponding 
to the same powers of s must be equal. Thus, eight nonlinear algebraic 
equations are formed which must be solved to give the eight unknown parameters 
in the feedback matrix G In Eq. (2-28). 

Given the eigenvalues specified in Eq. (2-29), the coefficients of the 
right-hand side of Eq. (2-20) can be computed. We have 


n (s - A.) = s 8 + 2.A9936 x10 2 s 7 + 2. 84334x1 O^s 6 + 1 .9438x1 0 6 s 5 
i = l 1 

+ 6.6624xio 7 s lf + 1.2103x!0 9 s 3 + 1 . 2699 x 1 o 1 °s 2 + 7.3946x]o 10 s 
+ 1.78289X10 11 (2-31 ) 


After algebraic manipulation, we have 

a 


det (s ! - A) ,s 8 + ^ 7 + \ 6 


8 


8 


+ + 
a 8 a 8 


a 3^ 3 + ^2^2 + a ± s + fo 


8 


8 


*8 


*8 


where a Q , . . . , ag are defined in Eq. (2- 13)- 

Therefore, a system of equations is obtained, 


a 7 = 2.49936x1 o 2 x o.2349xio" 2 = 0.5871 
a 6 = 2.84334 1 0 k x 0.2349x1 o' 2 = 0.6679X10 2 
a 5 = 1. 9438x1 0 6 x 0.2349xl0“ 2 = 0.4566x1 0^ 
a^ - 6. 6624x1 o 7 X 0.2349X10 -2 = 0.1 565 x 1 o 6 
a 3 = 1.2103X10 9 x 0.2349xl0" 2 = 0.2843xl0 7 
a 2 = 1.2699xl0 10 x 0.2349xl0~ 2 = 0.2983xl0 8 
a ] = 7.3946xio 10 x 0.2349X10 ” 2 = 0.1737X.10 9 
a n = 1.7829xl0 n x 0.2349xl0~ 2 = 0.41 88x1 o 9 
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A computer program was written to solve the set of equations involving 
a^, a-j , . . . , a^, using the Brown's method. The feedback gains are solved 
and are tabulated as follows: 

K p = 91338 
K r = 10081 
K ] = 6460200 
k 2 = 569930 
K 3 = -48943 
= 600900 
k 5 = 129920 

k 6 = 11756 

The computer program is tabulated in Table 2-1. 
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Table 2-1. Computer Program For the Computation of The Feedback 
Gains of the Closed-Loop ASPS By Means of the Brown's Method 


I M PL. LCl 1' f< E A L * C-3 ( A - H , 0-Z > 

0 T ME N S T 0 W R 0 0 TS < 2 , 50 ' 

COMMON r-iKSX , r-iKSP * AKSS •> RB ? AMI :> A 33 1 > n J ? A ;■ B ? C - .0 » E ? r , £i)j ( 31 
TYPE 5 

FORMAT <2X? -'THE DEGREE OF PiX) - •*) 

A CCIn F 1 T 6 ? N 
FGRrtA f < 12) ' 

' TYPE 7 

FORMAT < / ' SPECIFY THE ROOTS OF FIX) IN THE FOLLOWING v ' //'2\ , 

« ■■*** ALL COMPLEX ROOTS MUST BE IN COMPLEX CONJUGATE PAIRS ' - 

S - AND THEVSXy' ONE WITH NEGATIVE IMAGINARY PhR f SHOUT fi RF '» 
S ' SPEC [FI ED FIRST ♦ :**'* ' / ) 

00 1 I-~j ? N 
TYPE 2,1 

FORMAT ( /2X y ' REAL < ROOT' ' , 12 y ) =-■ '$) 

ACCEPT 9 v ROOTS ( 1 , I ) 

TYPE 3,1 

FORMA T ( 2X ? ' I MAG ( ROOT ; ? 12 * ' ) ••= ' % ) 

ACCEPT 9 y ROO f S < 2 y I ) ' 

CONTINUE 
TYPE 0 

FORMAT C/2X'y "LEADING COEFFICIENT » '*) 

ACCEPT 9 j COE i 
FORMAT <FI2 >5/ 

CALL RE CON C ROOTS . COE1 , jJD , N ’ 

TYPE 10 Hi 

i- OR'MA 1 ( /2X y ' COEFFTCIEN IS OF PCX's STARTING FROM IN A f op X.LJc'y 
?, I2»';7) 

TYPE A y C Dll C I ) y I - .1 y N f j. ) 

FORM AT C2Xy £112,5) 

-SYSTEM CONS TANTS 


AKSX-i , 051 
AKSF -0 , 005 
AK3S-0 * 005 
R B J. , 9 So 
AMI-300 , 
A33=2805 ♦ 15 
AJ-503 , 

A-RB 

j&~l + / AMI 
C - A M I & RB / A 3 3 
B--AJ/A33 
£-JL*/rt33 
F-l ♦ / AJ 


CALL SOL MLR < N > 

STOP 

ENO 
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3 


8 

8 

3.0 


3. i. 


■SUBkUijriNE RLCOW (ROOTS? A? DrN) 

D 1 HENS 1 1 JH ROOTS < 2 y 30 ) , 0 ( 5 J. J 

ft E 1 3 L % 8 ft ('3 0 T 8 » n U * T - 1 j 

DO i 1-1/ N 
cn i ) ~o * o 
continue 


EKiN-M )-1.0 

NS-NT i 

£10 T-J.S-N 

Nb^NS-I ■ 

IF ( ROD i S < 2 ? 1 ) j 3«7yl0 
T “ROOTS < i 1 1 ) 4421 ROOTS ( 2 * X 1 *#2 
U=2 < 0 * ROOTS ( 1 y 1 > 

DO" 17 j:=NL ? N 

D ( J- J. ) ~ 14' 0 C J- X ) - UTO ( J ) + D ( J+ X > 
CONTINUE 

D ( N ) -T& D < N ) -U4JLI < N+ X ) 

GO TO 9 
T = -ROOTS t l v .n 
DO 8 J~NL y N 
D ( J ) - r >KD < J ) f D ( J f JL ) 

CON riHLJE 
1)(N+1)=T*0<N+1) 

CONTINUE 

do ix n«i,Ms 
tuii>«d< i:i )4A 

CONTINUE 

RETURN 

END 

SUBROU T CHE SOLVER (H ) 

REAL 40 X t 00 > ? 0UH2 ( 50 j 55 > 

I NTEGER# 4 DU NX (50? 51 ) ? CNAME < 50 / 


§il©INAL PAGE rs 
OE ^OOR -QUALITY 


C INITIAL GUESSES OF THE SOLUTION 

C 


X ( 1 ) --O ^ 1.05 
X<2) 

X<3) --0.489D5 
X C 4 ) -O ♦ 57D6 
X ( 5 ) ~0* 64607 
X < <5 )=0. 117505 • 

X ( 7 > ~0 * X3D6 
X ( 8 > ~0 t- 6 06 
C 

0— -SPECIFY NAMES FOR EACH COEFFICIENTS FOR i'-RINl OUT 
C 


CNAME ( 1 ) ~ ' G ' 
CNAME(2)-'H' 
CNrtME <3 ) - / P 7 
CNAME < 4)- / Q' 
CNAME < 5 ) = y R ' 
CNAME 16) -=' Id ' 
CNAME < 7 )~ r T ' 
CNAi iE ( B )- : = ' U ' 



.Table 2-1. (Continued) 


-OTHER PARAMETERS TO BE SPECIFIED 


C 


10000 


J 0001 
10004 
10002 


Nb'LU-=12 

IF-0 

n rr -soo 


■ 1 HE NUMBER OF SIGNIFICANT UlblLS uESi/E 
HINT G'li-p MO * A Nil .LHPK'il'v'LU i-sPi ‘ ROX i t v ii'-i T X ON 
! maxi hum number of e terations fu be used 


n 

IF 


0 h L L .0 ! i 0 w N i ( N j ) J 1 1 ? i< 6 T 0 •> i* r I i; ? \ « it ON 1 v buriN ? F P * 3 1 > 
I F ( 1 N G < £ 0 . b ) W R 1 T E (5? f vOvQ > 

FORK AT < / / ' **A JACOBIAN RELATE)) MATRIX WHS 

INDICATIVE OF TOE PROCESS ' ' .BLOW FNC-UP 
WR1 IE (5i 10001) NIT 

FORMAT (' XctfNUMBER OF ITERATIONS - - ,13/'*.# 
WRITE (Gy 10004) 

FORMAT ■. ' **FEEDBACK COEFFICIEN fS p/) 

WRITE (5 s- 10002 ) ( CNAME ( J ) *X < ■! ) * J ~J.yN> 

FORMAT < t OX > A3 y • •= ' y D 1 2 < 5 ) 

RETURN 

END 


SINGULAR— 

• *L' ^ *’ \ 


/) 


SUBROUT I NE VKTHF < XAL K ) 

I MPL I C I T REAL *8 ( A~H ? Q-Z ) 

0 1 MENS I ON X (1 ) v rtRSft (10? 1 ) 

COMMON AKSX y AKSF' ? ALSO y RB y AN J y A3 3 y A J y A y )) » C y t‘i » £ ? F y DD (51 ) 
G-X < 1 ) 


H--X ( 2 ) 

* P^XT37 ' 

0=X<4) 

R-X ( 5 ) 

W-X < 6 ) 

. 1 “X < 7 ) 

U~ X !. H ) 

’ 01 --6*6 
02™ — b* ( H+AI\Sa ) 
03~A*C 
04~-E*P 


OS»-E# < Q+AKSP > 
06 -~E*R 
G7-D 


C- 

c- 

0- 


3 


4 


os=-f#w 

09- -F* < T+AKSS ) 

GIO*~F*U 

-THE VECTOR ARSR(Iyl) CONTAINS THE COEFFICIENTS OF THE N-TH 
-DEGREE POLYNOMIAL ORDERED FROM POWER N TO POWER 0 UF X — 

■ -ARSR < 1 y 1 ) IS THE COEFFICIENT OF X**N * ARSRC.TyJ.) IS THE COE 
-Cl ENT OF XY* ( N- .! > y ETC, 

ARSR ( 1 y 1 ) =1 ♦ -G3-G7 

GO TO ( I y 2 y 3'y 4 y 5 y 6 y 7 ? 0 ) ? K 

ARSR k2 y 1 ) ~~G1— -G4-G8+G1'!:67+G3*G8 

Y=ARSR ( 2 v 1 ) /ARSR ( .1. y I ) -D 0 ( 2 ) /OB ( I > 

RETURN 

ARSR <3- 1 ) =-02-G5~iJ9+81*G4+Gl#G3+C2*G7+G3*G9 f 04*60 
Y-ARSR < 3 y 1 ) / ARSR ( J. * 1 ) -DD f 3 ) / .OB ( 1 ) 

RETURN 

ARSR ( 1 y 1 j — “06— G J 0+01*05 f 01 TG9 f 02-i<G 4+02*06+03*010 
1 +64*69 T 65*6 8-01*64*60 

Y-ARSR f 4 y 1 ) /ARSR (1,1) -DD > 4 ) /BO ( 1 ‘ 

RE TURN 

ARSR (Si 1 >«Gi*Gi»+G l#G1 0+62*054 b2*G?+G !*G:L0+65*G^ 

S +G6*G8-G2*G4*G8-G 1 *05*GS~G 1 *64*6? 

Y-ARSR < 5 y I ) /ARSR ( 1 y 1 ) -DD ( 5 ) /DD (-1 ) 

RETURN 



Table 2-1. (Continued) 

ARSR ( 6 y .1. ) - 15 2 4cG6TG2#8J 0 FG5#G10+G6*G9~G2*G5lcG8-*Gl*G<&*R8 

- 62 Y 6 4 4: 69- 6 1 4 GhY69-~ 6 .1. :!< (3 4 L 6 j. 0 
V - A RSR ( 6 :■ 1. ) / ARSR .1 ? j ) -I'lD ( A ) / D 0 ( i ) 

REV URN 

aRSK ( ? y 1 ) ==G6*G 10 • G 2 * G 6 Y G 8 -- 6 2 C 6 5 Y 0 9 ~G j 3- 6 o'. 3419 ~G2';<G4;.M.3 I 0 
-Gi*05VGl 0 

Y-ARSR <7 r 3 ) /ftRSRt J. y 1. ) — i j i’f ("7 ) /Du ( 3 ) 

RE FUR.'l 

f'Rbia 8 y 1 ) := - 62:!ct3 l ')*6V -62'K6L.^G L 0 -6 14 66 KG LA 
Y~ARSR ( 6 v 1. ) /ARSR ( 3. s 1 > — D D ( 6 ) 'DD ^ ! ) 

HE TURiJ 

hRSR ( V y 1 J • = -82*0**1310 

Y-ARSR ( 9 y .1. ) /ARSR ( i 1 ) -D.0 ( 9 ) /DD < 3. > 

RETURN 

ENjCi 

SUBROUTINE BROWNZCNyNI r >NSIG* INGyXy INTER »COE» IP*L > 

REALMS X < i > * COE ( L y 1 ) yRELC y HOL'D i- H , F y FPL US ? OMhX y HIS i" v CR 
D I HENS ION INTER (L r 3 ) 

THE PARAMETERS NIT y NSI6 y I NO y INTER ARE M A X I T' y N U li S I G * S I N G U L 
ER OF THE ALGORITHM 216 RESPECTIVELY AND INTER (1 y NT 1 > .» CUE 
COE ( I y NT 3 ) ARE I SUB ( 1 ) y PART ^ j.’ ) p fL'MP ( I ) RE SPEC fTVFi V , 
NL'ERG-i 
ING-i 

R‘ELC“IO . 5|o!< ( -NS3IG ) 

C1=0 f EO 
C2=i <E20 
DO 91 M™! p NX T 

DO .10 <J : - 1 y N ORIGINAL PAGE IS 

OF POOR QUALITY. 

I Ft K ;'6TTlr)~CAf2L- BKSUB PC K iNsXy COE - INTER ?L T - 
ChLL • VKTHF CX y F y K 3 
FVR-0 ♦ 001 
LLY--0 


DO 20 1=K ? N 
I TEMP- 1 NTER ( K y I ) 

HOLD— X ( T TEMP ) 

. H- FTR&HOLB 

I F < H ♦ L'Q * 0 * 00 ) i 1-0 * 00 3 DO 
X f I TEMP ) -HULDTH 

I F C K ♦ GT . 1 ) CALL BKSUBT < K y M ? X * COE * X N i ER-L) 
CALL VKTI IF < X y FPLUS y K < 

COE C I TEMP * NT 2 ) •= ( FPLUS-F ) /H 

X(I7EMP)*HULD 

C3-DAB8 ( COE ( £ TEMP y NT 2) ) 

I F ( C3 ♦ EQ * C 3 ) GO TO 10 
C4=DABS(F/C3) ' 

IF <C4 »LE*C2) GO TO 20 
IS LLY-LLYTI 

20 CONTINUE 

IF ( LLY ♦ LE * ( N-K 3 ) GO TO 2 1 
FTR=FTR*10 

IF ( FIR » GT-* 0*6) GO TO 10<> 

GO TO. 11 

21 I F < K * L T . N ) GO TO 22 
IF(C3.EQ*CI) GO TO 100 
COE ( K * NT 1 ) -0 » DO 
KMaX-ITEMP 

go ro -u 

2 2 ■ KM AX - 1 i-J T ER i K , K ) 

DMAX--OABS ( COE ( KM AX r N f2 ) ) 

KPLUS=KT1 
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5^ 


30 


40 

41 
50 


58 

59 

60 


/u 

80 

90 


200 

91 


100 

111 


10 

20 


DO. 30 I«KPLUSfN 
JO UG= INTER < K ? I ) 

1 C3T-0 ABS ( COE < J3UB ,t\ r 2 ) ) 
IF < f EOT - LT » DNAA > G(J TO 23 
BMAX-TEST 

INTER ( KT-'U JR.j I > -KMAX 
RMhX : =jSU'B 


GO TO 30 

IN TER ( Kl-'i.US yl) -JSUB 
CONTINUE 

IF C DO DO < COE C KMAX > NT 2 ) ) , EG , C 1 > GO TO 1 00 
INTER < K y NT 1 ) -KMAX 


COE ( K f NT 1. ) ! =0 > DO 
DO 40 J-KPLUS ? N 
JSUB- INTER C KPLUS ? J ) 

COE t K v JSUB ) '---COE ( JSUB r NT 2 ) /COE ( KMAX r NT2 > 

COE ( K . NT 3. ) =COE ( !\ j NT 1 ) TCOE ( JSUB > NT 2 3 TX ( JSUB ) 

COE < K ? N f 1 ) - C COE C K r NT L ) -F 1 /COE i KMAX j- NT 2 ) TX ( KMAX > 


CONTINUE 


X ( KMAX ) -COE <N»N+1 > 

IF < N * G T * i ) C A LL 3 KEUDT ( N v N , X » C uL ? I NTER t L ) 
IF(M.EQ.l) GO i'O 80 


DO 30 I - 1 * N 

IF (X(I).EQ.Cl) GO .TO 58 
CR -DADS ( < COE ( I » NTS ) -X ( 1 ) ) /X ( I ) ) 
GO r 0 59 

CR=DABS < COE ( I , NT3 ) ) 

IF (CR»GT < RELC) GO VO 70 

CONTINUE 

N 0 E R G •= H M E R G f 1 

IF ( NvERO * GE v'3> GO TO J 11 

GO TO 80 

NOCRD -T 

DO 90 J “ 1 p N 

COE (UN f 3 > -X < X ) 

IF(IPtE0»0) GO TO 91 
WRITE 1 6 f 200 ) M » ( X < I ) f 1=1 » M ) 


FORMAT < J. 1. 0 9 5D20 ♦ 1 0 / 1 OX Y 3020 . 1 0 ) 
CONTINUE 


RETURN 

1NG-0 

RETURN 


NIT-M--J. 

RETURN 

END 

SUBROUTINE , BK SUB T < K ? N ? X * COE ? INTER ■/ L ) 
REAL TO X(l) v COE ( L y 3. ) 

D I MENS I ON I N f ER ( L » 1 3 
KN=K-1 

DO 20 I = .1 ? K'N 
I<M=K-IT1 

KMAX-- IN TER ( KN-1 ? NT 3. > 

X ( KMAX )-0 f DO 
DO 3.0 J=KM ? N 
JSUB- IN FEE* f KM •/ J > 

X ( KMAX ) ~X < KMAX > TCOE ( KM - 1 » JfiUd > TX < JSUB ) 
X C KMAX ) -X ( KMAX ) TCOE \ KM-1 -NT1 ) 

RETURN 

END 
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2,4 Time Responses of the Analog ASPS Designed by Pole Placement 

The time responses of the closed-loop ASPS with the analog controller 
des.igned by the pole-placement design conducted in the last section are 
studied by computer simulation. 

The listings of the computer simulation program are given in Table 2-2. 

The initial values of Xj(t), (t) , and (^(t) are: 

x j (0) = 2 x lo“ 3 

*!«>) = 0.013 

4 > 2 (' 0 ) = 0.013 

It should be noted that no nonlinear characteri sties are considered in the 
system model and the simulations. 

Figure 2-5 shows the time response of Xj (t) with the indicated initial 
condition. As indicated, the time response of Xj (t) decays to zero very 
rapidly, and the vertical axis of Fig. 2-5 is in a logarithmic scale. 

Figure 2-6 shows the time response of <f)j (t) with the given initial condition. 
Again, the response decays to zero so rapidly over the 4-second interval that 
the vertical axis is in logarithmic. 

The response of <i> 2 (t) is the fastest of the three, and a time response 
plot could not be made realistically over a 4-second time interval. Thus, 
the values of the response of <j> 2 (t) are tabulated in Table 2-3- 



Table 2-2. Computer PfOgran) For the Simulation of the Analog ASPS 
with Controller Designed by Pole Placement 


o 

\Z 


D I H Ci'i H 1 0 N P Ri i T < 5 ; * Y < 3 ) 
EXTERNAL i'- C 7 y OU TP ’ 
t; u i' i H AM X > .0 0 f #1*11 1 .1 " P ! i 


i DEFiY ( A " i'i'jX i 3 v 2 ) 

:l irr , , •• h i i n ? p h t 2 * p h r 


k* ! r 1 1 j y 03 S’iiJ; Hi i T 

1 1 O y SO y CO y DO yfcy)‘ 


AKbX “ A NOP ;■ lAi'.-t-o i-)35 .■ 
i END <1 


f PR f :■ A 


N P R TO .' 03 ? f U 7: ? J 0 3 y L I N E 
L) 1‘ • E i 1 ( U N I T ■= A y J 3 C V 1 1 • i i : - ; = ' JD 3 K ' 


fordo < uni ' 


2 ’Of ,p;li:OrO 
-J 5 .\!jJ L t B ;■ 

"AUr.vs- 


L EniE«0 
H -0 - 

TEND™ 100 * 

TFRT«0»2R 

TTNT«0*5E-3 

7 SET JrUflrtL COMHITIUNS 

X™2 » 0E -3 

xno r -o . 

PHI 3 =0,013 

ph .cm r=o* 

PHI1IN-0* 
l‘HI2 : - 0 * 013 
PHT2DT=0 * 

PH12IN=0 * 

AH 1=600, 

AKSX= i * 051 
AKSP-0 , 005 
A NS 3=0 ♦ 005 
A J =503 * 

A 33=2805,!T 
R.U = J , 9b6 
A0 : =KB 
80=1 ,/riMi 
C0=AMJ*RB/A33 
00=A J/A7T3 
E=1 , /h33 
F=J. , /A J 

0EI_rA : =l , -AOTCO-DO 
T=0» 

NPRT=0 

PRMT < 3 ) =TINT 
PR NT ( A ) =0 ♦ 05-YX 
HO 99 1*1*8 • 

99 DERYY I )-•••= 0 , 125 

NO J!M=G 


ORIGINAL' PAGE IS 
Or POOR QUALITY 


PRMT < 1 ) ■= r 
PRMT (2)= TEN D 

Y ( 3 ) =X 

Y ( 2 ) *XH0T 
Y(3>*PHilIN 
Y( 4>=PHI1 
'i ( 5 ) = PH I LOT 

Y f 6 )=PHI2IN 

Y ( V) =FHT2 
Y<8)*PHI2DT 


58 


l *■ 


QOUT" > 


CALL ‘ EKGS < PRMT y Y y DERY y NDIM ? IULF * FCT y C3UTP r AUX ) 
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Table 2-3-. Time Response of <j>^ of .The ASPS With The Analog 
Controller Designed by Pole Placement 
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111. SAMPLED-DATA CONTROL OF THE ANNULAR 
SUSPENSION AND POINTING SYSTEM (ASPS) 


3.1 The Sampled-Data Controller 

The sampled-data controller for the ASPS is obtained by incorporating 
sample-and-hold devices in the control inputs for the dynamics of x^, ^ and 

^ , using the same feedback gains as designed in the analog controller. The 
design objective is to select an appropriate sampling period T for the sampled- 
data ASPS. 

The sampled-data ASPS is represented by the block diagram of Fig. 3-1. 

The Q. blocks represent the effect of- quantization which will not be considered 
at present. 


3.2 Stability Analysis of the Sampled-Data ASPS by the z-Transform 

The signal flow graph representation of Fig. 3~1 is shown in Fig. 3“2. 
The following equations are written directly from the signal flow graph. 
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Taking the z-transform on both sides of Eqs. (3 _ 1) through (3“3) , we have • 
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Substitution of Gj, G 2> G^, G^ and G^ into the last nine equations, we can show 

by partial fraction expansion that the functions G./A , G D /A, G„/A, G n /A, G^/A, 
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Gp/A, Gj/A, Gj/A, and G^/A are of the following form: 


G . (s) 

“X” 


20 - e" TS ) 


f a..s + b,,a). a,_s + b-._ta„ a._s + b.,W-> 

il ill, i2 i22, i3 1 3 3 . 

+ = — -r h 


a. , 


2 2 
s + 


2 2 
s + oj 2 


2 2 
s + oi^ 


(3-7) 


where i = A, B, C, D, E, F, I, J and K. 


w-j = 1 . 31 01 4x1 o” 3 
w 2 = 3.55991xl0 " 3 
« 3 = 3. 77726x1 o -2 


A] = 7.65934oixlo' 6 

b Al 

A2 = -5. 21 24686x] o" 4 

b A2 

A3 = 6.894976 

b A3 

B1 = -3.1 77573x1 0" 3 

b Bl 

B2 = -7.8558545X10" 3 

b B2 

B3 - 3.5257182 

b B3 

C1 = -6. 6321 553*1 o"** 

b Cl 

C2 = 3. 6432745x1 o' 2 

b C2 

C3 = -3.5504543 

b C3 

D) = 1 . 1 863223x1 o 6 

b oi 

D2 - 3-9724468x1 o 5 

b D2 

D3 = -1. 583584x1 o 6 

b D3 

E] = -6.1833492x10 s 

b El 

E2 = -2.78681 94x1 o 7 

b E2 


5-2968403x10 
- 1 .3266373 
1 .653877x1 0 3 

-2.1974837xl0 ? 
-1 .999412x1 o 1 

8.4570434xio 2 

-4.5865363 
9.272583x1 0^ 
-8.5l63773xl0 2 

- 1 . 371 1851 x 1 o 2 
-1 .2475924x1 0 2 
5. 2770228x1 0 3 

7.1468909x10^ 

8.7523256xlo 3 
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a E3 = 1 .8435832x1 O 5 
a £k = 1.2920375XI0 9 

a pl = -1 .2905753X10 8 
a p2 = 1 .2924317X10 8 
a p3 = -1 . 8564023x1 0 5 

k 

a | j = 2.3031281x10 
a j 2 = -1 .71 36123x1 0 5 
a | 3 = 1 .4832586xl0 5 

a J1 = -1 .2004364x1 0 7 
a J2 = 1.202163X10 7 
a = -1 .7267858x10^ 

w J 

a K1 = -5.80131X10 7 
a K2 = - 2 -5l88685xl0 6 
a„_ = 4.4225387x10 s 

rO 

a ^ = 1 . 2017944 xl 0 8 


b p3 = - 6 . 1434254 X 10 2 

b p] = 1 . 4916845 x 10 ^ 
b _ = - 4 . 0590328 x 10 ^ 

F 4 

b p3 = 6 . 1865076 x 1 o 2 

b M = - 6.5239325 
b , 2 = 1 .31 8941 x 1 0 2 

b j3 = -1 .21 13775x1 0 3 

b J1 = 3.4oo4o4lxio 3 

b J 2 = - 9 - 2528628 x 1 0 3 
b = 1 . 4 l 02663 xl 0 2 

b K1 = 4 . 4651788 x 1 0^ 
b K 2 = 7 . 1 - 350445 x 1 0 2 
b„, = - 3 - 611 8882 x 1 o 3 


a A4 ■ a B4 ~ a c4 ' a D4 ■ a F4 " a l4 " a J4 “ 0 

Equations (3-4), (3~5) and (3-6) are represented by the digital flow 
graph of Fig. 3~3- The characteristic equation of the sampled-data ASPS is 


determined by evaluating the A of the signal flow graph of Fig. 3~3- We have 
G. G p G G G 1G G. G G 

a(z) - 1 -30 - 30 - 30) - 30>$0>-- J0>J0 - *0)30) 

G G, G G G G , G. G,_ G G,. 

- is i-iwim-jp - Kfw x)^x } + ^x ) ^ ( x ) + x-fiw-p 


+ - VtWtWt* 


(3-8) 
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Since and to^ are small, and b.jto. « a.^ for i = A, B, C, D, E, F, 

I, J, K, and j = 1 , 2, 3, the z-transform of G./A can be approximated and 
simplified. This is justified as follows: 


„ 2(1 - --l;o a Al 5 * b Al“l , °A2 S * b A2 M 2 , a A3 S + b A3 M 3 
*-s(s 2 + (I) 2 ) s(s 2 + w 2 ) s{s 2 + ( 0 ?) 


(3-9) 


For small u^T, 


a Al ZSinM l T , b Al z 

w, (z 2 - 2zcosw.T +1) W 1 


sino^T = a^T 


cosu-jT - 1 


Equation (3“10) becqmes 


z(z - cosw^T) 
— - 

z - 2zcoscjo^T + 


,. f a Al s + b AI M l 

0 (2 2 , 

[ S(S + COj) 


V T 

(z - 1) : 


(3-1 1 ) 


Thus, Eq. (3~9) becomes 


\ _A „ 2T / . A a _ 13-.-7889T 

®U J z - I a Al a A2 a A3^ z - 1 


( 3 - 12 ) 


, G 

*ir 


2T ( a + a + a i „ 7.029369T 
z - 1 V B1 B2 B3 J z - 1 


(3-13) 


(r 1 


# T < a c, + a c 2 + a C3> - :I T^Y S1 


(3-H) 


»r 


_2I_ ( a + a + a ) o -3*.0*T 
z - 1 U D1 + D2 + D3 J z - 1 


(3-15) 


U_ 

ir- 


z - 1 ^ 2a El + 2a E2 + 2a E3 + a E^ “ F^l 


(3-16) 



7.1“ 


L A j 

G i 


2T . . v -0.46T 

( a rl + a irl + a r?J = 




r r ^ 
G J 


z - I 'FI F2 a F3 7 z - 1 


2-T- , . A x —8.1 8T 

(a,, + a .o + a,,) = 


v* , 


K 


z - 1 '“11 12 13' z - 1 


2T / % -3.71.6T 

(3,1 + 3,0 + a,o) = 


z - 1 '“J! J2 D J3' z - 1 


T /« , o , rj . \ _ 1 0 * 7T 

(2a.,, + 2a., 0 + 28^* + a,*. ) - 


( 3 - 17 ) 

( 3 - 18 ) 

( 3 - 13 ) 

( 3 - 20 ) 


_ z - 1 ' M Kr "°K2 ^ a K3 r K4 y ” 

Substituting these terms into Eq. (3-8) and simplifying, we have the 
characteristic equation as 


z 3 - (3 + U.^Tjz 2 + (3 + 26.978T + 36l.59T 2 )z - (1 + 13.^91 + 361. 59T 2 

+ 687T 3 ) = 0 (3-21) 

It should be noted that the digital ASPS is originally a twel veth-order 
system. Because co^ , and to^ are very small, the analysis conducted here 
results in a third-order approximation with the characteristic equation given 
in Eq. (3“2l). When we neglected and in essence we have made a 

variation on the unit circle in the z-plane. Thus, the stability criterion 
should be modified to \z\ < 1±£ where e depends on the value of (i)^ , and 
(0^. As a matter of fact, for small sampling periods, the characteristic roots 
of the system are all very close to the z — 1 point in the z-plane. 

The roots of Eq. (3—2 1 ) for T = 0.001, 0.01 and 0.1 sec are tabulated 
as fol lows : 


T = 0.001 sec 

z = 0.9372, 

1 .038 ± j 0 . 0604 

T = 0.01 sec 

z = 1 . 0192 , 

1 .0578 ±j0. 175 

T = 0. 1 sec 

. z = 1 .203, 

1.573 ±j 1.7*78 


Although in a strict sense these roots are all outside the unit circle, 
and the corresponding system are all unstable, as discussed above, the roots 
for T = 0.001 sec are so close to the unit circle that if enough accuracy 



72 


were carried out in the analysis without approximation, these roots could 
actually be inside the unit circle. In any case, for T = 0.1 sec or greater 
the digital system is definitely unstable. As will be verified by computer 
simulation results in the next chapter, the digital ASPS is stable for T = 0.001 
sec and unstable for T = 0.1 sec, with the stability boundary being somewhere 
around T = 0.0075 sec. 

Therefore, the approximation conducted on the z-transform analysis still 
gave useful results on the stability condition of the digital ASPS with respect 
to the sampling period T. Because the characteristic roots of the system are 
all very close to the z = 1 point for stable values of T, an accurate analysis 
using the exact model is almost impossible even with the aide of a digital 
computer. 



IV. COMPUTER SIMULATION OF THE DIGITAL ASPS' 


4.1 The Digital ASPS V/ith The Sampled-Data Controller 

It was discussed in the preceding chapter that the digital ASPS was 
obtained by placing sampl e-and-hol d units in the control inputs of the x^ , 

$1 and (J) components, using the same feedback gains as designed for the conti- 
nuous-data system. The z-transform analysis conducted in the last chapter 
showed that the digital ASPS is unstable for sampling periods greater than 
0.01 seconds approximately. 

The computer listing of the simulation program for the digital ASPS 
without guantization effects is given in Table 4-1 . 

The simulation results verified that the digital ASPS neglecting 
quantization is unstable for sampling periods greater than 0.01 second. 

When the sampling period is less than or equal to 0.075 seconds, the 
simulated responses remained stable. 

Figure 4-1 illustrates the time response of the X| dynamics when T = 

0.005 seconds. The initial conditions are: x^ (0) = 2x10 ^ and x^ (0) = 0. 
Figure 4-2 shows the same response of x-j for t greater than 6 seconds. 

The vertical scale is changed to show the oscillatory characteristics as the 
response decays to zero. 

Figures 4-3 and 4-4 illustrate the time responses of (f>j and <j p 
respectively, when T = 0.005 seconds. 

Although the overshoots of the time responses of the digital ASPS are 
quite large for T = 0.005 sec.. It can be shown that these overshoots are 
substantially reduced by reducing the sampling period T. 

4.2 The Digital ASPS With Quantization 

In this section the effect of quantization in the sample-and-hold 
channels of Xj , <J>^ and <p^ is investigated by means of computer simulation. 



Table A-l . Computer Simulation Program of the Digital ASPS. 


7 * 


niHffNCtQN PRMTC5) / TiO) ? JUErtY ■■ 8 > >AUXl 8x8’) 

EXTERNAL FCT y OUT P 

COMi lOW X r XDT) I' v i-'HI i • PH £1 OT v PHI 1 IN * PH 1 2 x EH'! 207 I 'MI 2 IN - T :■ 

V 1 r *,'2 f V3 y A J x AM I » AKSX - AKSP .» AKS« r A 33 ? TPRT r ft 8 - DEL T A v 
i )0 ? SO y Cu ? DO y E y F “ FEMu •> 

NPft i y L'Ol y 102 y l'V3 LINE 

OPEN C UNIT-6 9 DEV £(.•!=“ •' OSK / :■ FILE- ' F0R20 , DAT ' y ACCESL- *' WLT-UjI 1 1 ' > 


LINE- v 
7 SP-0 < 005 
H-0 . 

TI£Nll-iOO* 

TPRT “ 0 * 05 
FINT-0 » 511— 3 

C GET INITIAL . CQNU CT10NS 

X-2 * OE-5 
XDGT-0 , 

Pi II 1-0 ♦ 013 


99 

10 


PHIlOT-O* 

PHI 1 IN-0 * 
PH12~0 * 013 
FHT2DT— 0 ♦ 

PH I 2 IN- 0» 

AN I -600 f 
AKSX-l *051 
AKSP=0 ♦ 005 
AKSS— 0 «• 005 
A J-503 » 
A33=2805*lt 
RB'* I. * 956 
AO-RB 
.80=1 t/Anl 
C0-Ah‘I*RD/A33 


D0=AJ/A33 
E-l » /A33 ‘ 

F-1*/AJ 

DELTA-1 * -AO#CO-DO 
T— 0 1 


Ml “RT-O 

PRMT (3) -TINT 
PRMT < -4 ) =0 *01 
DO 99 I '-1 y S 
DERY ( I > =0 ♦ 125 
•Nl.i IN -8 


IF ( T < G£ * TEND ; CALL EXIT 


V1=0 < 91338D5*XT0* lOOSlOStfXBDT 

V2=0 . o4602U7#F HI 1 INTO * 56993Do#PHI 1 -0 , 489 4JD 


ssruiuiT 


V3=0 , 6 0090 0 6 # P H X 2 1 N T 0 „ l2992tto*PHI 2 TO 


1 1 7 5 6£f5-fc PH 1 2.0T 


PRMT C 1 ) -T 
PRMT U>*T+T3P 
f < i ) =X 

Y (2)--XD0T 

Y ( 3) -PI ill IN 
Y(4)-F‘HI1 

Y (5) -PHI IDT 

Y <6 )=PH.T2IN 
Y(7)»PHI2 
Y'( 8 ) -PH1-2DT 
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1 00 


200 


CALL RKGS ( PRMTy Y . DERY ytlfilM ■■ IHLF ■> FCT 'HJTP ? AUX ) 

00 TO tO 

END 


■ TSDUfaitiriNE" FCrtXXY Y y'BERVr 
B I M E H S 1 0 rl Y < 0 ) » .0 £ R Y 1 3 ) 

COMMON X* XDOTy PI !l j. * PHI 1*0 r t PHI 1 IN ? PH t 2 y i'!IX2DT •• PH E 2 J. N :• 1 r 
i 01 y 02 r 05 u A J y AMI y MKwX ? f-)KSP y AKSS y A55 y FPE’fyRB «u£i 1 A ■■ 

?> AO y BO y CO r BO * E t F t TEND r 
£ NP R T * T 0 1 » 1 02 y 1 0 3 y L I N E 
DERYCl)=Y<2) 

0ERY(2>=<< -Vi#80-AKSX#HOiitY<l))#a.-DO)+AOJitt ( -Oi-AKGP’K i 
£ + ( V3+AKSS#Y < 7 > > *F*BO .» ) /DELTA 

DERY ( 3 )-Y { 4 ) 

DERY ( 4 ) « Y ( 5 ) 

DERY < 5 ) -~ ( C-V2-AKSP#Y<4> >*E- < oi+AKSXSYt J > > YBOYOO 
l + ( 03 {- ft K S S * Y (71) *D 0 Y F )/'0E LTD 

OERY’f 6 >-Y (7?) 

DERY ( 7)=Y (0) 

BER Y < 8 ) - t ( “05— AR'SSYY < ? > ) YFY ( J. . --AOYCO ) + ( 02+hKSP Y / *, 4 > ) YE 
i -HOI + AK3X * Y < .1 ) ) YBOTCO ) /DELTA 

RETURN 
END 

SUBROU TINE OUTP < XX y Y - DERY y I HLF r ND l‘M y PENT) 

DI MENS I ON Y(S) , DERY ( S ) t PRNT ( 5 ) 

COMMON X y XDOT y PH 1 1 y PHI 1 DT y PH 1 1 IN > PH 12 y PH 1 2D T r PH 1 2 1 N y T > 
& 01 y 02 y 03 rA J ? AMI y AKSX 7 AKSP v AKSS y A35 y TPR f y RB y DEL > A * 

a AO y DO y CO y .0 0 y t? i- y i hND y 
S • NPRF y 10 1 y 1 02 y 1 03 * LINE 

li ( XX , CT * T END ) PRrfT ( 0 > -I * 

T “XX 

IF < XX DDT TPRTJKFi.OAT « NPRT ) > RETURN 
LINE-LINE-f t 

(JR I FE ( 6 y 1 00 ) I HLF y XX ? (Yi I) ? j ~ 1 . 0 ) 

FORMAT (IX y 12 y 5X y 1 PE 1 0 > 4 1 1P8E1 1.5) 

X“Y < 1 ) 

XDO F=Y (2 > 

PHI 1 IN” Y C 3 ) 

PHIl-Y t 4 5 


ORIGINAL PAGE IS 
OF POOR QUALITY 


PHTiDT-»Y(S) 

PHI2IN—Y (6) 

F’HI2— Y (7 ) 

PHI2BT — Y (8 ) 

NPRT -NPR r-fl 

IF ( LINE * L F - 10 ) GO TO 200 

WRITE (5 y 'J 00) II ILF r XX r ( f ( 1 > t I-i -0 ) 

.LINE-0 

RETURN 

END 


<4 J ) Y-E 
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The computer program listing is given in Table 4-2. 

When 8-bit quantizers are placed in any or all of the input channels 
of the digital ASPS the system is still stable, and no sustained oscillations 
were observed. Figure 4-5 shows the phase plane trajectories of versus x-j 
of the digital ASPS with and without an 8-bit quantizer. The quantizer is 
placed only in the x^ channel. 

Figures 4-6 and 4-7 illustrate the time responses of <j>^ and respectively, 
with the 8-bit quantizer for Xp and T = 0.005 seconds. 

Figure 4-8 gives the phase plane trajectory of x^ versus x^ when a 16- 
bit quantizer is placed in the x-j channel only. The trajectory of x^ with 
the 8-bit quantizer is also shown in the same figure for comparison. Note 
that for the same time instants the response of x^ with the 8-bit quantizer 
is greater than that of the response with the 16-bit quantizer. The phase 
plane representation of is chosen because of the high oscillations in the . 
responses which make the time response difficult to plot. 

Figures 4-9 and 4-10 illustrate the time responses of <j>^ and , 
respectively, for T = 0.005 sec and a 16-bit quantizer in the x^ channel. 

The overshoots in these responses are smaller than the corresponding ones 
in Figs. 4-6 and 4-7 which are for the 8-bit quantizer. 

Figures 4-11, 4-12 and 4-13 show that results on the responses of Xp 
<f>-j and <|>2, respectively, when an 8-bit quantizer is placed in the <j^ channel 
only. .The sampling period is 0.005 seconds. 

Figures 4-14, 4-15 and 4-16 show the time responses of Xp and cf)^ , 
respectively, when an 8-bit quantizer is placed in the <j ^ channel only. The 
sampling period is 0.005 seconds. 

Figures 4-17, 4-18 and 4-19 give the time responses of Xp cj>^ and $ , 



8 } 


respectively, when an 8-bit quantizer is placed in each of the three control 
input channels, and the sampling period is 0.002 seconds. As mentioned earlier 
the oscillations and overshoots are substantially reduced when the sampling 
period is smaller. 
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Table 4-2. Computer Simulation Program of the Digital ASPS with 
Quant i zat ion . 


*'C 


O.THENS J ON PRf'iT ; 5 > » Y ( R ) ? OERY ( , 1 "» ? AUX ( S SO 
EXTERN mi.. FC T-OUTP 

00 ill « D i'J X-XDOT y PH/ L yPM i IDT ?PMI L.TN?Piil2.«-PI iI2DTyPHI2iN* T v 
9 I » V'? ? 05 f ft J i Ah I ? ftKSX y f-ihSP v AKSS r A33 :■ Ti-'ii J \> SO :■ .DELI A :> 
fiO 00 y CO :• 00 * ? I" * I END * H ? 

ME R'f y J V 1 1 I 02 ? 1 03 y L INC 

OPEN i UN 11=* f )JE VICE- ' DSK y r FI LE= ' FON20 * DA T' " ? ftULl£SS= ' SET-TOUT - > 


L1'NE=0 
TSP =0 < 002 
H=2 ; JjiJfc-S 
TEND=100. 

1 PRT=0 f 05 
TINT=0*5E~4 

C SET INITIAL CONDITIONS 

---- J. < Q E 3 
;<D0T=O , 

1-' HI J. =0.0 02 
PJII1D7-G. 

PHUIN=0, 

PH 12=0 * 002 
PH 1207=0 ♦ 

PHI2IM=0* 

Aii J>600* 

AKSX= 1*051 
AKSP=0 c 005' 

AKSS=C .. 005 
AJ=5 0 3 v 
ftS3=2*305* .15 
R.O=i. * 936 
A0=R8 
.80=1 */AMI 
C 0 •= A Pi I % R B / A 5 3 
00=A J/A33 ' 

E-l */A33 
F=t * /A J 

DELTA -l.-AO*CO -BO 
T=0> 

NPRT =0 

PPifT (3)=TJ NT 
PRMT ( 4 > =0 * 05YX ‘ 

00 99 1=1 y 8 
99 OERY (I) =0,1 25 

N .0114=8 

io IF ( T » OE * TEND ) CALL L~ * , 

-01=0 , 91 J38D5»X-tO , 1 008. 1. .05 YX DOT 

02=0 * 64602D7KPHI.L INTO * 56 9930 61- PI II 1 -0 ♦ JQ94305YPHT i OT 
V 3= 0 . o 0090 0 6 1< PH 12IN+0»12? 9 2 .0 6 Y P H 1 240* 1 f. 7 5 6 0 S# P H 1 2 0 f 


Call tiuAR rzT^D 
CALL QUANTZ ( 02 ' 
Call QUnNTZ(V3> 


PR HI ( 1 > •= i 

pRii r < 2 > = r i rsp 
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YiJ) -X 

■f ( 2 > -xdg r 

V < .3 1 ~Ph i i N't 

V <. A ) “1 V H X i 

{ K O ) ’-PHI I U 1 

V t 6 ) ~!-'H J 21 N 
YtV)=PHI2 

V (S) — l-*i II2JUT 


0 ft L L R K G S < P R M Y s Y ? DER Y y Nil .CM » I H L F > FC T y 0 U T P - A U X ) 

GO 10 10 

END 


SUBROUTINE 

COMMON X ? X.00 r ? PH 1 1 • PHI 1 B rVpMTi IN? PH 1 0 ? PH 1 2B f » PH 1 2 T N * T r 
-V 1 f y2r03 f A J y"Fi itIt AN Ox? ftts©!"' ffiXhif 5 ; A'33"-TPr\T :■ KB v ui-XTft v 


ft hO s> BO ? CQ * DO y £ ? F r » TEND ? H v 
& N P R r !• X V 1 ? 1 02 » 1 03 ? I. T N E 
IF (XX t l_T » 0 > ) GO TO 20 
TV«(XX/HJ+0.5 
GO TO 30 
XV=<XX/H)-0.5 
XX=FLOAT<IV)*H 
RE TURN 
END 


ORIGSm PAGE m 

§£ QUALITY 




la GRAPH PAPERl nriAPmc; CQNrani s corpohatioim Builaio New York AS MID -E8 !S X !D DltlSIOHS ID THE IHCH 

Ponied m U S A 
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15i GRAPH PAPFR l QflAPHlD CONTHOLb COMPOflAflON Birfl&lO New Yo/ AS ) 110 -GO 20X20 DIVISIONS 10 MINCH 

• PmitwJ ii) U S A 




GHAPl l PAPbRl GHAPMJC CONTROLS CORPORATION DuUnfa, New Voi \ AS 1 1 tO “CD 20 X 2fl DIVISIONS TO THE INCH 

PniilitlinU s A 
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GRAPHIC CD N I NO L Si CORPORATION Bui Mo New York ^ 1110 -GO 2Q X 20 DIVISIONS TO Till MCfl 
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V. DESIGN OF THE ANALOG ASPS THROUGH DECOUPLING 
AND POLE PLACEMENT 


5.1 introduction 

in Chapter II the analog control lers or tne Hits are designed tor the control 
of the x, and (j>^ dynamics. The eight eigenvalues of the system are assigned 
so that the overall system has an equivalent bandwidth of 2 Hz. We shall see 
later that this is not an accurate description of the bandwidth requirements of 
the system. 

The analog controllers consist of eight state-feedback gains with no coupling 
between x, <p^ and <j> 2 . in other words, the input u^ of the x component Is affected 
only by feedbacks from x and x, the input u 2 of the component is affected only 
by feedbacks from /cj)^ , and . Similarly, the input u^ of the component 
is realized by feedback from the states /<j> 2 , <j> 2 and (|> 2 . Therefore, the three 
independent controllers are essentially PID controllers. 

The values of the eight feedback gains are determined by using the Brown’s 
method for pole-placement. The sampled-data version of the x, and <j> 2 dynamics 
of the ASPS was obtained by inserting sample-and-hol d devices in the three input 
channels. It was shown in Chapter III that using the feedback gains designed 
for the analog system, the sampled-data system is stable for sampling periods 
less than or equal to 0.0075 seconds. However, this sampling period is still 
considered to be too smalj to be economical and practical for the ASPS. 

5-2 Design of the Analog ASPS Through Decoupling And Pole Placement 

As it turns out the desired bandwidths requirement of the ASPS Is as 
fo 1 1 ows : 

x^ dynamics 0.04 Hz 


<j>^ dynamics 


10 


Hz 



fOQ 


4>2 dynamics 


1 Hz 


Since the <j>^ dynamics is 250 times faster than the x dynamics, it is 
virtually impossible to find an equivalent bandwidth of the overall system and 
establish a general eigenvalue requirement for the system. Therefore, it is 
necessary to decouple the x, and <j > ^ dynamics through state feedback and 
simultaneously place the poles to realize the desired bandwidths for alT three 
system components. The problem is stated as: 

Given the system 


where 


x(t) - Ax(t) + Bu_( t) 


x(t) 



u(t) = 


V'n 

U 2 (t) 

u^(t) 


(5-1) 


(5-2) 


(5-3) 


A is the 8x8 coefficient matrix and 8 
is defined by 


JJ_( t) = -Gx(t) 


is the 8x3 


input matrix. 


The state feedback 

(5-4) 


where G is the 3x8 feedback matrix. The elements of G are to be selected so that 
the coefficient matrix of the closed-loop system, A - BG, has the following form: 



10 1 


A - BG = 


r a 

. i 

i 

i 

0 

1 0 
1 

0 


A 

i 0 

1 

2 

I _ 

0 

1 

0 

"f X 


1 

; 3 J 


(5-5) 


where 


Aj is a 2x2 matrix for x 
^2 ' s a 3x3 matrix for $ , 

^ is a 3x3 matrix for . 

The eigenvalues of A^ ? A^ an d are so selected that the bandwidths requirements 
are satisfied. 

Referring to Fig. 2-1 the A matrix of the ASPS has the following form: 

0 0 0 0 0 


A = 


0 


a 2'l 


0 

0 

a f 

0 

0 


51 


81 


1 

0 

0 

0 

0 

0 

0 

0 


0 

0 

0 

0 

0 

0 

0 

0 


i 2k 


1 

0 

a 

0 

0 

a 


3 54 


84 


0 

0 

I 

o 

0 

0 

0 


0 

0 

0 

0 

0 

0 

0 


27 


0 

0 

a i 

1 

0 


57 


87 


0 

0 

0 

0 

O' 

1 

0 


(5-6) 


The B matrix Is written as 


B » 


21 


51 


81 


22 


52 


82 


23 


53 


(5-7) 


83 
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where the a..'s and b,.'s in the A and B matrices are given as 
U »J a 

a 2] = -0.61207568 

a 24 = _1 • Zl8if42 7 2 x 10 _3 

a 27 = 1.4844272 x 10~ 3 = - a 2h 

a 5l = -0.31202659 

a sk = -7.589096 x 10 _ * 

a 57 = 7.589096 xlO" 4 = -a 5k 

a 8l - 0.31202659 

a 84 = 7.589096 x IQ'* 

ag 7 = -7.6884996 x 10 4 

b 2l = 0.58237458 

b 22 = 0.29688544 

b 23 = -0.29688544 

b 5l = 0.29688544 

b = 0.15178192 

b 53 = -0.15178192 = -b 52 

b gl = -0.29688544 

b 82 = “0. 151781 92 

b 82 = °* ^376999 


It is simple to show that B has full rank (rank = 3). 
Let the feedback matrix be represented by 



9 11 

9 1 2 

9 1 3 

9 l4 

9 1 5 

9 ! 6 

9 1 7 

9 18 

J 


G = 

9 21 

S 22 

9 23 

9 24 

9 25 

9 26 

9 27 

S 28 

(5-8) 


9 31 

9 32 

9 33 

9 34 

9 35 

9 36 

9 37 

9 38 



Then BG becomes 
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BG = 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


21 


51 


81 


where 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


22 


52 


82 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


23 


53 


83 


0 

(bg ) 24 

0 

0 

( BG ) 5 4 

0 

0 

< BG >84 


(BG)..= l b.,,g 
k=1 


U 'k a kj 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


25 


55 


85 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


26 


56 


86 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


27 


57 


87 


0 

(BG) 

0 

0 

(BG) 

0 

0 

(BG) 


28 


58 


88 


1 = 1 , 2 ,. .., 8 , j = l , 2,. ..,8 


(5-5) 


In order for A - BG to be a diagonal matrix, the following relations must 

hold : 


(BG) 

23 

(BG) 

2b 

(BG) 

25 

(BG) 

26 

(BG) 

27 

(BG) 

28 

(BG) 

51 

(BG) 

52 

(BG) 

56 

(BG) 

57 

(BG) 

58 

(BG) 

81 

(BG) 

82 

(BG) 

83 

(BG) 

8 b 


a 23 

a Zh 

a 25 

a 26 

a 27 

a 28 

a 51 

a 52 

a 56 

a 57 

a 58 

a 8l 

a 82 

a 83 

a 8^ 


= 0 

= 0 
= 0 

= 0 

= 0 
= 0 

= 0 

= 0 
= 0 
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(BG)g5 a 85 0 

These equations represent 16 equations with 24 variables in the feedback gains 
g 5j ( 5 = 1 ,2,3; j=l ,2, . . . ,8) . 

For the present design, the x dynamics is specified to have a bandwidth of 
0.04 Hz. Since the x dynamics are represented by a second-order system, the 
bandwidth of the system is given by 


= a) ( 1 - 2? 2 + Vkt? ~ 4? 2 + 2 }' 


(5-lD 


if we choose the damping ratio £ to be 0.707, then 


BW = 0) 


( 5 - 12 ) 


where is the natural undamped frequency. 

Therefore, for the x dynamics, the eigenvalues are selected to be at 


where 


p 1 » p 2 = a ] ± J a ] 


. _ 0.0* X 2n „ _ 0 t?8 

1 n 


(5-13) 


(5-14) 


The <j>. and ^ dynamics are of the third order. However, we can use second- 
order approximations by placing the real root far to the left on the real axis 
in the s-plane. For this case we let the real root of the <j>^ dynamics be placed 


p^ = b 2 - -200 


(5-15) 


Then, the complex roots are: 


p 4’ p 5 “ a 2 — J * a 2 


(5-16) 


where 


a = _ 2ir x 10 = -44.436 

2 n 


(5-17) 


Similarly, for the dynamics, we let 


= b„ = -20 


p 6 = b 3 


(5-18) 
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Then , 

P jy Pg ~ a g i. J a g 


(5-19) 


where 


2ir x 

~7T~ 


- -4.4436 


( 5 - 20 ) 


The characteristic equations of the three decoupled subsystems are as 
f o 1 1 ows : 


x component:’ (s - a^ - ja^)(s + + ja^) 

» s 2 -2a j s + 2a 2 = 0 (5-21) 

45 1 component: (s - b 2 ) (s - a 2 -ja^) (s - a 2 + ja 2 ) 

= (s - b 2 ) (s 2 - 2a 2 s + 2a 2 ) 

= s 3 - (2a 2 + b 2 )s 2 + (2a 2 + 23^) s - 2a 2 b 2 = 0 (5-22) 

<$2 componwnt: (s - b^) (s - a^ - ja^)(s " a g + ja^) 

= (s - b^) (s 2 - 2a^s + 2a 2 ) 

= s 3 - (2a 3 + b 3 )s 2 -i- (2a 2 + 2a 3 b 3 )s - 2a 2 b 3 = 0 (5-23) 


If there exists a set of feedback gains such that the decoupling of the 
subsystems x, ^ and <f> 2 can be accomplished, then the decoupled closed-loop 
system will have the independent characteristic equations of Eqs. (5-21), (5~22) 
and (5-23). 


Let the matrix A of Eq. (5-6) be written as 


A = 


A 

X 

X 


11 


X | X 


22 


33 


(5-24) 


where A^ denotes a 2x2 matrix, A 22 and A^ are 3x3 matrices. The submatrices 
denoted by X contain elements which are unimportant for the immediate development. 
In view of Eqs. (5-5) and (5-9) , the decoupled x dynamics with state feedback 


can be expressed as 
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(5-25) 


where 



0 

0 


0 

1 

_ (BG> 21 

(BG) 22 _ 


*21 - (BG) 21 

• (BG >22 


(5-26) 


The characteristic equation of is 


s I 



s 


S 21 



-1 

S + (bg) 22 


= s 2 + 


(BG) 22 s - 


a„ , + 

21 


(BG) 


21 


= 0 


(5-27) 


Similarly, the decoupled <j>^ dynamics with state feedback is described by 



where 


A 2 A 22 


0 

0 

(BG) 


0 

0 


53 


(BG) 


5^ 


o 

0 

(BG) 


55 


0 1 0 
0 0 1 


-(BG) 53 a 5h - (BG) 5lf -(BG) 


55 


The characteristic equation of is 


| si -A, = 


s 

0 

(BG) 


-1 


0 

-1 


53 


-a^ + (BG)^^ s + (BG) 


55 


( 5 - 28 ) 


(5-29) 
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= s 3 + (BG) 55 s I 2 + (<BG) 54 - a^js + (BG) 53 = 0 (5-30) 

For the <p 2 component, the decoupled closed-loop state equations are 


(5-31) 


— — 

* 


r Tt 

x 6 


X 

ON 

k 7 

ro 

<! 

II 

x 7 

1 

x • 

co 

1 


, 

co 

X 

1 


where 


A 3 A 33 


0 

0 

(BG) 


86 


0 
0 

; (BG) 86 a 87 

The characteristic equation of is 

s -1 


0 

0 

(SG) 8 7 

1 

0 

- (BG) 


0 

0 

(BG) 


87 


88 
0 
1 

“(BG) 


88 


I s i - A, 


( BG ^86 “ a 87 + ^ BG ^87 s + ^88 


= s 3 + (BG) 88 s 2 + ((BG) ft7 - a fi7 )s + (BG) 


(5-32) 


87 87 j 


86 


(5-33) 


For pole placement ? in order tc meet the bandwidth requirements, the corresponding 
coefficients of the characteristic equations in Eqs. {'5“27) , ( 5“ 30) and (5— 33) 
must match those of Eqs. (5 _ 2l), (5 _ 22) and (5~23) , respectively. - 
Thus, for pole-placement, 

s 2 - 2a ^ s + 2a ^ 2 = s 2 + (BG) 22 s + (BG) 2] - a £1 (5-3*0 

s 3 - (2a 2 + b 2 )s 2 + (2a 2 + - 2a^b 2 

= s 3 + (BG) 55 s 2 + ((BG) 54 - a 54 )s + (BG) 53 


(5-35) 
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s 3 - (2a 3 + b^s 2 + (2a 2 + Zajo^s - 2a 2 bg 

« s 3 + (BG)g 8 s 2 + ((BG) g 7 - ag 7 )s + (BG)g 6 (5-36) 

Equating the like coefficients in the above three equations, we have 


(BG) 

22 = 

b 21 

9 1 2 

+ 

b 22 9 22 

+ 

b 23 9 32 = 

-2a ^ 


(BG) 

21 

b 21 

9 11 

+ 

b 22 9 2l 

+ 

b 23 9 31 

2a 2 + 

a 21 

(BG) 

55 = 

b 51 

g 15 

+ 

b 52 S 25 

+ 

9 53 9 35 = 

" (2a 2 

+ b 2 ) 

(BG) 

5k = 

b 51 

g l4 

+ . 

b 52 S 24 

+ 

b 53 9 3^ = 

2a 2 + 

2a 2 b 2 

(BG) 

53 = 

b 51 

9 13 

+ 

b 52 S 23 

+ 

b 53 g 33 = 

-2a 2 b, 

Z i 

> 


(Bg) 88 ~ b 8 1 9 1 8 + b 82 9 28 + b 83 g 38 ~ ~^ 2a 3 + b 3 ) 

(BG) 87 = b 8 l 9 1 7 + b 82 g 27 + b 83 9 37 = 2a 3 + 2a 3 b 3 + a 87 

( bg ) 86 = b 8] g l6 + bg 2 g 26 + bg 3 g 36 = “2a 2 b 3 


Notice that the 16 constraint equations on the feedback gains in Eq. (5 _ 10) 
are conditions on decoupling of the three subsystems, whereas the 8 constraint 
equations in Eq, (5 - 37) are the conditions for pole placement. The 2k constraint 
equations contain 2k unknowns in the elements of the feedback matrix G, g.^, i=l , 
2,3, j=l ,2, ... ,8. 

The 2k constraint equations in Eqs. (5-10) and ( 5— 37) can be written as 


where 


WG 


C 


21 

b 22 

b 23 

51 

b 52 

b 53 

81 

b 82 

b 83 


(5-38) 


G is the feedback matrix given in Eq. (5~8) , and C is a 3x8 matrix whose elements 
are composed of a 2 , a^, b^ , b 2 , bg, and a.j, i=l,2,...,8, j=l,2,...,8. 

The feedback gain matrix G can be solved form Eq. (5~3S) if W is nonsingular. 
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G = W ’c (5-39) 

to be nonsingular, it is necessary and sufficient for B to have full rank, 
or the system parameters given for the ASPS, the feedback matrix is solved 
q. (5-39), and the results are given as follows: 

g n = 36.449 

g 12 = 212.4 

g 13 = -9-256981248 x 10 8 
g ]4 = -2.5471 626624 x 10 7 
g 15 = -3-3892568 x 10 5 

9]6 = 0 

9 1 7 = 0 

g l8 = 0 
g 2] = -73.35 

g 22 = -41 5-4544 

g 23 = 2.2126125552 x 10 9 

g 24 = 6.0882526771 x 10 7 

g 25 = 8.1012732 x 10 5 

g 26 = 3-96750304 x 10 5 

g 27 - 1 .091703152 x 10 5 

g 28 = 1 .452664 x 10 k 

g 31 - 0 

s 32 “ 0 

g 33 = 3^96750304 x 10 8 
g 34 = 1 .091703152 x ?0 7 
g 35 = 1 .452664 x 10 5 
g 3 6 = 3.96750304 x 10 5 


no 


atr ix 



uuix 


9.998x10" 


.999x10 


^ceding pag^bLmk mot nueo ' ' 3 

0 -2.968xlo“ 7 -1 .979x1 0~ 9 0 2.968xlO _7 1.979xlO~ 9 


-1.224xl0 -2 9.998XI0" 1 0 -2.968x10 -5 -2.968x10 _7 0 2.968xlO _5 2.968xlO ~ 7 

-4.l60xl0 -7 -2.080xl0~ 9 1 1 .999x1 0 -2 1.999x10"^ 0 l.Ollxlo” 9 5.059xl0 -15 

-6.240xl0 _5 -4.l60xlo " 7 0 9.999xlO _1 1 .999x1 0~ 2 0 1 .51 7x1 0~ 7 l.Ollxlo” 9 

-6.240xl0 -3 -6.240xl0 -5 0 -1.517xlo" 5 9.999xl0 -1 0 1.517xl0 -5 1.51 7x1 0~ 7 

4.l60xl0 -7 2.080xl0 -9 0 l.Ollxlo -9 5.059xlO -12 1 1.999xlO -2 1.999xl0 -Zl 

6.240X10 -5 4.l60xl0 _7 0 1.517xlO -7 l.Ollxlo -9 0 9^999xlO -] 1.999xlO _2 

6.240xl0 -3 6.240x10~ 5 0 1.517x1 O -9 1 .517x1 O -7 0-1.537x10 -5 .9-999xlO -1 

( 6 - 12 ) 


1.164x10' 


5-937x10 


-5.937x10 


1 . 164x1 0 


5.937x10 


-5-937x10 


3-958x10' 


2.023x10 


-2.023x10 


9(0.02) = 


5-937x10 


5-937x10 


3-035x10 


3-035x10 


-3- 958x1 O -7 -2.023x10* 


-3-035x10 


-3.035x10 


2.050x10 


(6-13) 


' -5-937x10 


-3.035x10 


3.075x10 


-5-937x10 


-3-035x10 


3.075x10 


For the same bandwidth requirements described in Chapter 5 , the following 
eigenvalues are selected in the s-plane: 
x component: (0.04 Hz bandwidth) 

P ]} P 2 = -0.178 + J0.178 

<j >1 component: ‘ (1 0 Hz bandwidth) 


p^ = -200 



m 


P^, p 5 = -44.436 + j44.436 
<f>2 component: (1 Hz bandwidth) 

p 6 - -20 

P 7 , P 8 = -4.4436 + J4.4436 
Ts 

Using the transformation z - e , these eigenvalues are transformed into 
the z-plane. The corresponding z-plane eigenvalues are: 

x: z r z 2 = 0.9964457 + JO. 0035417 

q> ] : z 3 = 0.01831564 

z k , z 5 = 0.2592945 + jO. 3191948 
<P 2 : z 6 = 0.67032 

Zy, Zg = 0:911366 + j0. 096987 

The condition of decoupling of the closed-loop digital system given in Eq.. 

(6-8) results in 42 constraint equations. This is due to the fact that Eq. (6-8) 
represents 64 scalar equations, but there are 42 zero elements in the matrix. 

The pole placements of the eighth-order system would produce 8 more constraint 
equations, so there are only 24 unknowns in the feedback matrix G. Therefore, in 
general, there would not be a set of solutions with more equations than unknowns. 
However, a closer look at the elements of (T) and 0(T) reveals that some of the 
elements are extremely small so that a good approximation can be obtained by 
assuming that these small elements are zeros. In other words, the state transition 
matrix $(0.02) given in Eq . (6-12) can be approximated by the following matrix. 
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9.998x10 _1 

1 .999x1 0" 2 

[ 0 

0 

0 

1 

|0 

0 

0 

-1 . 224x1 0~ 2 

9.998x10 _] 

0 

| 

-2.968x10 ” 5 

-2. 968xl0 r 7 

I 

[0 

2.968x10" 5 

2. 968x1 o" 7 


- — — — _ 

1 

1 

-2 

-4 

r - 

— 

— — ~~ 

0 

0 

1 .999x10 

-i 

1 .999x10 

-2 

10 

i 

0 

0 

0 

0 

0 

9-999x10 

1 .999x10 

1 o 

0 

0 

-6.240xl0~ 5 

-4. 160x1 O' 7 

'1 0 
i 

r 

-1 .517x1 O - '’ 

9.999x!0" ] 

1 

1 0 
1 

1 .517xl0 _5 
-2 

1 ,517xlo" 7 
-4 

0 

0 

|0 

i 

0 

0 

I 1 

1 

1 .999x10 
9.999xl0 _1 

1 .999x10 

-2 

0 

0 

i ° 

0 

■ 0 

1 0 

1 .999x10 

6.240xl0~ 3 

6.240xl0 -5 

i 

i ° 

1 .51 7x1 o" 5 

1 .517xl0 -7 

j 

I 0 

-l -537xlo" 5 

9*999x1 o"^ 


(6-14) 


Similarly, we can approximate 0(0.02) by the following matrix: 


0 

0 

0 

1.1 64x1 0“ 2 

5.937xlO -3 

-5.937x1 0~ 3 

0 

0 

0 

0 

0 

0 

5-937xl0 -3 

3.035x1 O -3 

-3.035xl0~ 3 

0 

0 

0 

0 

0 

0 

-5. 937x1 o" 3 

-3.035x1 0“ 3 

3.075xl0 -3 


(6-15) 


Then, the matrix 0(O.O2)G becomes 



116 



Based on Eqs . (6-14), (6-15) and (6-16), the following 16 equations are 
obtained for decoupling the <p - 0G matrix: 

(6G) 23 = e 21 g 13 + 8 22 9 23 + 6 23 9 33 = ^23 = ° 

(6 g ) 2 4 = 9 2 1 9 14 + 6 2-2 9 24 + 6 23 9 34 = ^24 = “ 2 -9 68xl0 ~ 5 

( 0G ) 25 = 0 21 9 1'5 + 8 22 s 25 + 8 23 9 35 “ ^25 = -2 -9 88x, ° 7 

( 0G) 26 = 8 2 1 9 1 6 + 8 22 9 26 + 8 23 9 36 = ^26 = 0 

(8G) 2 7 ~ 8 21 9 17 8 22 9 27 8 23 9 37 = ^*27 ~ 2 *568x10 

( eG ) 28 = e 21 9 1 8 + 9 22 9 28 + e 23 9 38 = ^28 = 2 ' 968x10 7 

(0G)^i — + 8 52 9 21 + 9 53 9 31 ~ ^51 - ~ 8 ‘ 2 ^ Gx ^0 

( 0G) 52 = 9 51 9 12 * 9 52 9 22 + 9 53 9 32 = ^52 = ' 4 * l60xl0 ~ 7 

( 9G ) 56 = 0 5 1 9 1 6 + 9 52 9 26 + 9 53 9 36 = *56 = 0 

(02)57 ~ 0 5 l 9 1 7 + e 52 g 27 + 8 53 9 37 = ^57 = 1*517x10 

( 0G ) 58 = 0 5 1 9 1 8 + 9 52 9 28 + 9 53 9 38 = %8 = , - 517xl ° 

( 0G ^ 81 = e 8 1 9 1 1 + 9 82 S 2I + 9 83 9 32 = ^81 = 8 - 2Zt0xl ° 3 
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( 0 G) 82 = 0 8 1 9 1 1 + e 82 9 22 + 0 83 9 32 = *82 = 6 ‘ 2AOxl ° 5 

(0G) 83 = 03,9, 3 + e 82 g 23 + Q 83 9 33 = ^83 = 0 

(00)31} = 6 81 9 14 + e 82 9 24 + 6 83 9 34 = ^84 = 1-517x10 5 

( 0G ) 85 = 0 8l 9 1 5 + 6 82 9 25 + 9 83 g 35 = *85 = 1,517x10 7 

The eight additional constraint equations for the solution of the 24 
elements of the feedback gain matrix G come from the pole placement requirements 
on the submatrices, Ap and Ay 

After the matrix <j> - 8G has been decoupled, it can be written as 


<j>(0.02) - 0(0.02) G = 


A, 1 0 10 

.-la_ -i 

0 1 a, 1 0 
. _ u — 


0 0 


( 


K 


(6-18) 


where 



*11 

1 

CM 

-©~ 


0 

0 

_> 

II 



- 



*21 

*22 _ 


(06) 21 

^22 


J 11 


9 n 


*21 - (9G) 21 *22 • (8G) 


22 


(6-19) 



“*33 

*34 

*35 


! 

0 

0 

0 

— 1 

A 2 

*43 

*44 

*45 

- 

0 

0 

0 


_*53 

*54 

*55 _ 


(00)53 

(00)54 

(00)55 

r 

*33 


*34 

* 35 

1 



p 43 


*53 "- (eG) 53 *54 - (9G) 54 *55 ' 


*44 

(06), 


*45 

(0G) 


55 


( 6 - 20 ) 
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^66 

^67 

^68 


0 

0 

0 

A 3 

^76 

<f> 77 

-~-J 

CO 

- 

0 

0 

0 


^86 

^87 

^88 


(0G) 86 

(6G) 87 

(0 g) 88 


^66 

^76 


^67 ' ^68 

<i>77 ^78 


^86 “ ^ eG ^86 ^87 " ^ 0G ^87 ^88 " ^ 0G ^88 


The characteristic equation of the decoupled x dynamics is 


(6-21) 


zl - A 1 


2 “ <hl ^12 

- < f > 2 j + ( 0^^21 2 ™ ^22 + ^ 0G ^22 


z + (( 0 G )22 ] ^ 22 ^ 2 + ^ 11^22 "" ^ 11^ 0G ^22 + ^ 12^ 0G ^21 ~ ^ 21 ^ 

= (z + + j b 1 ) (z + aj - j b 1 ) (64 22) 

where = -0.9964457 and b } = -0.0035417. 

Now solving for the unknowns in Eq. (6-22), we have 

(0G) 2] = ©21 9 1 1 + 9 22 9 21 + 0 23 9 31 

" (a l + b ! + 'f’li + 2a I*ll + ♦]2*21- ) (6 ' 23) 

(eG ) 22 “ e 21 9 12 + 6 22 9 22 * 0 23 9 32 ^11 * ^12 + 2a l (o- 24 ) 


For the <j>j dynamics, the characteristic equation of A 2 is 


zl- A 2 => 


- 4> 33 

- ^34 

- ^5 

" ^43 

2 ' hk 

“ *45 


- (j) 53 + (0G) 


53 - <f > 5 4 + ( 0 g ) 5 4 


z “ + (0G) 33 


- z^ + ((eG)^ - ^5 - <p hli - ^ 3 ) Z 2 + (-(cp^ + (J> 33 )(eG) 55 + 4>4 5 (© G ) 5 2j 
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+ +35 (6G, 53 ' * 54+45 + +33+55 + +33+44 " +43+34 ' +35+53 + + 44 + 45 ^ 

+ ((* 33*44 " +43*34) (SG) 55 + (+35*^3 - < f> 33 I t > 45 > CeG) 54 

+ (+34+45 " + 35 + 44^ ( 0G ) 53 ~ + 33 + 44+55 + + 33 + 54+45 + +43+34+55 
' +43+35+54 ' +34+45+53 + +35+44+53} (6 ~ 25) 


where 


The desired characteristic equation is written as 

(z + a 2 + -i b 2^ ( z + a 2 “ J b 2^ ( z + c 2 ) = 0 

c 2 = -0.01831564 
a 2 = -0.2592945 

b 2 = -0.3191948 


Equating Eqs. (6-25) and (6-26), we get 


( 6 - 26 ) 


( 0g ) 5 5 e 5 1 9 1 5 + 6 52 9 25 + 0 53 s 35 ^55 + ^44 + 1 + 2a 2 + c 2 (6-27) 

( 0G ) 5 4 = 0 5 ] 9 1 4 + e 52 9 24 + 0 53 S 34 

- <j> (1 + 2a + a 2 + b 2 ) (1 + c ) , 

^45(^35 + <£>34^45 " ^35^44) + ^45 + ^ ^55 + ^44 

+ 3 + 2a 2 + c 2 ) - <J>44<f>4 5 + 4>4 5 4> 5 4 " <£>55 - <£>44 + 2a 2 c 2 . + a 2 + b 2 ) (6-28) 

(60)53 = 0 51 9 13 + 0 52 9 23 + 0 53 g 33 

(1 + 2a 2 + a 2 + b 2 ) (1 + c 2 ) 

" +35 + +34+45 - +35+44 <6 ' 2s! 


For the $2 dynamics, the characteristic equation of 'is 
2 " ^66 " ^67 " ^68 


zl - 


A 3 I = 


‘^76 

<J>86 + ( 0G ^ 86 


- <p 


11 


^87 + ^ 0G ^87 2 ' ^88 + ^ 0G ^88 


^78 

*88 



120 . 


- Z 3 + ((QG)gg - <|>gg - <f> 77 - <j> 66 )z + (“($77 + 88 + ^78^ 0G ^87 

+ 4 > 6 q (© G ) S6 ~ $ 3 7 $ 7 8 + $ 66$88 + ^ 66^77 “ $ 76$67 " $ 68$86 + $ 77 ^ 78^ z 

+ (($ 66$77 " $76$67^ ( 0G ^88 + ($68$ 7 6 " $ 66 $ 78^ ( 0G ^ 87 

+ ($6 7 $ 7 8 " $68^77^ 6G ^ 86 “ $66$77$88 + $ 66 $ 87$78 + ^ 76 ^ 67^88 

” $76$68$87 " $67$78$86 + $68$77$86^ (6-30) 

The desired characteristic equation is written as 

(z + ag + jbg) (z + ag -j bg) (z + Cg) = 0 (6-31) 

where Cg = -0.67032 

a 3 = -0.911366 

bg = - 0.096987 

Equating Eqs . ( 6 - 30 ) and ( 6—3 1 ) , we get 


(0G) 86 e 8l g 1 6 + 6 82 9 26 + 6 83 9 36 

(1 + 2ag + ag + bg) (I + Cg) 

$68 + $67$78 ” $68$77 


( 0 G) 87 - 0 8 ,9 17 + 6 8 2 s 27 + 0 83 s 37 

- $58^ + 2a 3 + a 3 + 63) (1 + c 3 ) ] 

$ 78 ($68 + $67$78 " $68$77^ $78 ^ 77 ^ 88 

2 . 

- <J> 77 4> 7 8 + $ 78 $8 7 ’ $88 “ $77 + 2a 3°3 + a 3 + b V 
9G ^88 = 0 81 9 1 8 + 9 82 9 28 * e 83 9 38 


+ <|> 77 + 1 +2ag+Cg) 

(6-33) 


= $gg + $ 77 + 1 + 2ag + Cg (6-34) 

Equations (6-23), (6-24), ( 6 - 27 ), (6-28), ( 6 - 29 ), ( 6 - 32 ), (6-33) and (6-34) 
form the additional eight constraint equations, together with the i6 equations 
in Eq. (6-17) are adequate for the solution of the 24 unknown feedback gains ir 



The solution of the 24 constraint equations gives the following results 


g n = 35.432513595904985 
g ]2 = 209.57461847387285 
g 1 - -9.368484250209332x1 0 7 
g 1 ^ » -8.11 397701621271 032x1 0 6 
g ]5 = -1.4453443216549823 x10 5 

9 16 = 3 1 7 = 9 l8 = 0 
g 2 , - -71.361744259885901 

g 22 = -409.94846384061196 

g 23 = 2.23926411 02247482x1 0 8 

g ^ = K 93941 05849068884x1 0 7 

g 25 - 3 . 454675889387745x10 s 

9 26 = 3.57827252O216161x10 5 

g 27 = 1.32396931 35355619x10 6 

g 28 = 1.27497371 7087571 5xl 0 4 

9 31 = 9 32 = 0 

g 33 = 4. 01 5292755500438x1 0 7 
g 4 = 3.47761 6257040601 9 x 1 O 6 
g 35 = 6 . 1 94684677849835x1 0 4 
g 36 = 3.57827252739 2904xl'0 S 
g 37 = 1.3239693094l2944xl0 S 
g 3 g = 1 .27497371 29324844x1 O 4 
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VII. COMPUTER SIMULATION AND DESIGN OF THE DIGITAL ASPS 
7.1 Introduction 

In the preceding chapter the digital ASPS was designed through decoupling 
and pole placement. In general, the decoupling problem does not have a unique 
solution. However, in the ASPS it turns out that some of the elements of 
the matrices (f>(T) and 0 (T ) are very small so that the matrix 6G can be approxi- 
mated by a matrix which has only one nonzero row. We recall that the design 
objective is to realize simultaneously the following bandwidth requirements 
for the x, $ ^ and components of the system: 
x: bandwidth = 0.04 Hz 

<f>| : bandwidth = 10 Hz 

cf> 2 : bandwidth - 1 Hz 

However, the "partial" decoupling of these components means that the desired 
bandwidths cannot be realized directly by the design method outlined in Chapter 
VI. A trial-and-error method is used to determine the feedback gains to meet 
the design requirements. The method involves first assuming a desired bandwidth 
for x, BW = 0.04 Hz, then we compute the required feedback gains, simulate 
the digital system, and observe the time responses to see if the individual 
bandwidth requirement is satisfied. If any one of the bandwidth is not 
satisfied, we adjust the bandwidth of x again, and repeat the process until 
we come close to the desired bandwidths. Only the bandwidth of x is varied 
in this case-, since the bandwidths of <f>j and <b„ are not so sensitive to 
parameter variations. 

In Chapter VI the digital ASPS was designed using the sampling period 
of 0.02 seconds. in this chapter larger sampling periods are considered. 

It is shown that the digital ASPS with state feedback can be stabilized for 
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a sampling period as large as 0.1 second. 

7.2 Computer Simulation Results, T = 0.02 sec 

in Chapter VI, we set the sampling period at T = 0.02 sec, and required 
that the bandwidths are 0.04 Hz, 10 Hz and 1 Hz, respectively for the x, <f>^ 
and $2 components. These bandwidth requirements correspond to a set of z- 
plane eigenvalues which the closed-loop system must realize. The corresponding 
feedback gains are obtained as in Eq. (6- 3 5) - The computer program listing 
for the design and simulation of the digital ASPS is given in Table 7“1» Figure 
7- 1 shows the time response of x(t) when the feedback gains are as given in 
Eq. (7—35) . Notice that the response is very slow which corresponds to a 
system with a very narrow bandwidth, certainly much smaller than the desired 
value of 0.04 Hz. By reassigning the bandwidth of x, it is possible to fine 
tune the dynamics of x, <f>-| and (f^. However , due to the coupling of the three 
components, it is extremely difficult to obtain the exact responses desired, 
depending on how the bandwidth is defined. In any case, the closed-loop 
eigenvalues of the system are placed at the desired location by the state 
feedback design. The desired eigenvalues are now specified as follows: 
x: Zj , z 2 - 0.964471639922 + jO. 00342947 

^ : z 3 = 0.01831564 

z 4 , z 5 = 0.2592945 + j0. 3191948 
Zg = 0.67032 

Zy, Zg = 0.911366 + jO. 096987 

Note that only z-j and are changed, but the other six roots are still the 
same as those specified in Chapter VI. The pole-placement design now yields 
the following feedback gains: 


= 3643.66148126889 
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g ]2 = 2128.0189640019839 
g 13 = -9.3684842502093316 x 10 7 
g ]2{ = -8.11397701621271032 x 10 6 
g, = -1 .4453^^3216549823 x 10 5 

s l6 = S 1 7 g l8 = 0 
g 21 - -42330.651505108181 

g 22 = _1 °394. 9030571 83335 

g 23 = 2.2392641102247482 x 10 8 

g 22} = 1.9394105849068884 x 10 7 

g 25 = 3-454675889387745 x 10 5 

g 26 = 3.5782725250216161 x 10 5 
g 27 = 1.3239693135355619 x 10 6 
g 28 = 1.2749737170875715 x 10^ 

g 3l = g 32 = 0 (7-0 

g 33 = 4.0152927555004380 x 10 7 
g 3 4 = 3.4776162570406019 x 10 8 
g, c = 6.194684677849835 x 10^ 

5-3 

g 36 = 3.5782725273929039 x 10 5 
g 37 = 1.323969309412944 x 10 6 
g 38 = 1.2749737129324844 x 10 4 

Note that except for g^ 1 , g 12 , g^ and g 22 all the other feedback gains are 
identical to those given in Eq. (6-35). The time responses of x, <j>j and <£ 2 
for these feedback gains are shown in Figs, 1~2,' 7“3 and 7~4, respectively. 
These responses are very close to having the desired bandwidths. 
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Table 7-1 . Computer Program For the Design and Simulation of the 
Digital ASPS 


e 

r 


19 


te 

c 

c 

c 


c 

c 

c 


I MF'LT C C r REAL YS < A • | j , O' / 

CALC ULhT ION OF GW AND EM FOE FHC* f 01 NT f-.Y P01H ; METHOD 
CALCULATION Bf SERJ ES 0! iiiinYf TOM 

D i. MENa .i. ON .A ( 8 « 0 » D f 0 y .) ) > GO <. >,i ■■ <3 / ? G M •' ■ Q ) o j - >, ~l » « j~;,j * •[ a j *< 

DIMENSION STMTS ( S ? 8 > y 1 1 < 3 y 8 } .THETAC CirY y 1 1 ILTnB ( 0 « 32 »V.C( 0*0 j 
DIMENSION 3TMTC (O y 8 ) *LW<3> » MM < 3 > s WOKKl ( 3y 3) y UGRK2 i 3 „ 0 ) 5 WORK'S (Os- 8> 
D IMENSION WORK 4 ( <3 » 8 ) y WORKS < 8 y S ) y WGRj ,'6 C 0 y 3 ) > MORN 7 < , ; : 1 ) > WONKY i 3 •> O ) ' 

DIMENSION WI ( 3 * 3 ) yW0£3»8? 

DET-0 > ‘ ‘ 

KMAX*2000 

N=S 7 _ 

M---3 


DO .LB I ~ 1 v N 
DO 19 J»t*M 
D(I . J)»0» 

H ( J y 1 2 * 

GO ( Jy T )=0 * 
DO 18 J— 1 9 N 
A < T »J) =0 » 


SYSTEM CONSTANTS' 

AMI*AOO* 

. AKSX--1 *051. 

AKSP--0 * 005 

AKSS-0 * 005 
A J---503 * 

A33-2805 * j 5 

RD-J. , 956 
AO ~Rjfi 

B0=1 * / Aril 

00=hM.DKRB/A33 
DO=A J/A33 - 

E~1 »/A33 
F-'l. * /A J 

DEL fA«I - -AO^Co-DO 


ORIGINAL PAQEJS 
OF POOR Q UALITY 


NON-ZERO ENTRIES OF THE MATR L'CES 


A(1.2M. 

A ( 2 y 1 ) =-BO#AKSX* ( I * -DO ) /DELTA 
A (.2 y A > -- - E Y A K S P T A 0 / D ELY A 

A < 2 y 7 ) ••=AKSS*F*nO*AO/DEL T A 

A(3»4)*l * 

A ( 4 y 5 ) - 1 , 

A < 5 y I ) -- - AKSX^BO.YCO/DEL l A 

A ( ix» A ) AKSP&E/DELTA - 
A < 5 y 7 ) *AKSS*D0*F /DELTA 
A C 6 y 7 J ~1 * 
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T 


A <7*0 )=I ♦ 

A ( 8 « I. ) “ AKSX^rtA^CO/Vfl-L f A 

A I H 9 4 ) HA!i^lPML£nO TA 

A ■' 0 ”7)~ -•AKBS^i : '.{? ( l. ♦ -AOTCO ) / Vifr.'i. T, i 
8(2/0 -BO* < i * - 00 ) / DEL fn 

D^/Ll-E^O/DELrA 

Vi (' ■' / X ) •■3 -Ft OO^rtO/mil. T A 

n 1 5 o 1 > ™ B 0 * CO/ 0 E L. T A 

0 ( b / '.? J -E/ DELTA 

li ( 6 f j ) no#r/nitL ta 

B ( 8 y J ) - -BO^CO/BI: I.TA 

R ( 8 / 2 1 ; ='-E /DELTA • 

h ( 0 y 3 > -K* ( 1 , - A O'KCO ) / .DELTA 
AOCLy l >-3»6447E.1 

GO(.l ?2)-2 Y 24 E 3 . 

GO ( 1 / 3 1 -•-? . 25694.1. 248E0 
GOX 1 / 4 ) — _ 2 . 5 '17 L 826624E7 
GO ( 1 9 G ) - -3 , 389456 GE5 
GO ( .t y * ) -0 - EO 
GO <■'. i. )--7,?>55El 

G 0 2 * 9 ) -- A - 1 5 4544IZ 1 

GO < 2 / 3 > “2 ,21261 25052E9 
GO ( 2 / 4 ) =6 ♦ 08826266241: 7 

GO ( 2 / 51-8, 1 0 1 273 2iZ‘5 

GO (2/61 -3* 76760304 f~5 
10 ( 2 • 7 ) 1 , 07 I 703 1. 52E5 
GO ( 2 « S ) ! = J. > 4 62664 OE 4 
GO ( 6 . Z )~J> 76 72.. 060 TEG 
GO (3/4 > •••• L ♦ 07 1 703 1. 5 7E7 

GO (3, -5) --■} '4876611:6 

GO ( 3 1 6 ) ™3 „ 96 76030 4E5 
GO < 3 / 7 ) •=.! ,073 703 I EG 

GO (3/8 3 - 1 ,4 62664 El . 

1 J ( 3 / .! ) “0 . 99 
H( 3. ? 7) =0*01 

H ( 2 / 3 ) - 0 » ()7l 

ci ( 2 / 4 ./ ""O + 78 
H (2 « -"i 1 - 0 < 01 
IK 3* A>-0* 01 
M ( 3 / 7 ) -0 , 98 
11(3/81-0,01. 


ORIGINAL RAGE IS 
QF POOR QUALITY 


TYPE 107 

00 201 J--3 *N 

20 L TYPE 1 1 0 > ( A ( J./ 1 ) r 1 ~3 / N ) 

TYPE 100' 
no 902 J" 1 / N 
TYPE 21 0 1 < a < J > 1 J / . 1-1 / H ) 
TYPE 307 

00 203 J-J./M 


202 


V2Z 


-203 


r yt*e. 1 . 1 o , no i JfD. t ~ i :■ n j 


K i 


OU 


30 

40.1. 


.! 0! ; V 1 

'E 501 


fd RiRflAT <4X* 'FCRST PASS u! STKnAT') 

CAL L. SIP HAT ( A ? U v T ■ S HITS* WORKS y K I :■ WGElC4 y WORKS ) 
IF < KJ -KM AX) 30.20*20 


CAL 


GMPRD < U0RK3 r 8 « T! IE TAG * N , N.y M J 


FORMAL ( 4X r "THE 


P ( ATT ) MATRIX") 


40; 


UU 403 I~i f M • 

TYPE 1 1. 0 f < S I MTS ja» 1 :>(D 

TYPE 403 


4 (J3 FORMA f ( ■ *X y " THE THE T A MATR f X " ) 

00 404 I — f. / N 

4 04 T Y P E 2 J 0 • < T HE T AS ( 1 * J ) r J = i y i i ) 


PI =3 ► 3 4:1.0923336 
DS02-3. ,/SQRT<2. > 

FA C 1 • - 3. , Y T 40802*2 ♦ *P I 


FAG2--0 * 8*T#DSQ2*? - #P I 
FAC3-0 * 134T40SQ242 . YPT 
Ar-=- DEXP t -FACJ ) YGCOS (F AC1 > 


o J;=-~ oexp-c ~r- aci > tns i m < fao i > 

C J.~ - OEXP ( -200'v *T ) 

r AC/2 ) *0l :0S ( F i'iC 2 ) 


B.2-- OEXP < l r AC'2 ) *iih JW < ! : AC2 ) 
C2----DEXP ( -20 v-i i’> 

A3» OEXP f -FACS ) * 0CQS<FAC3 ) 


50 i 


03--~- OEXP < -FA 03 ) YDS. EH \ i"A03 ) 
TYPE 503 

FOR? lAT < /4 X . " #*** POLES Of 


i nr. 


» ESCRlT I IT 8 i S i'HMYYn X ' ) 


TYPE 502y A3. ?B.I yCl. 
TYPE 502 * A 2 » B2 » C2 
TYPE S02yri3»D3 


so: 


FORMA r ( / 4/ if 3. P3E2 1 , 1 2 ) 
W f t 1 y i ) - THETAS ( 2 y. L) 

W E ( !. y 2 ) “THE IAS ( 2 y 2 ) 


WI < 3. y 3 ) = THETAS 02 y 3,) 
U E < 2 y 3. ) = rHETpS ( 5 y 3. ) 
W E ( 2 » 2 ) “THETAS ( 15 * 2 3 


. WT < 2 » 3 ) *TI IE TAG ( 5 y 3 ) 
WH3*t'«THETASv8»i> 
W I ( 3 y 2 )• -THETAS ( 8 y ? ) 


WI (3y3)-THETAS(8y3) 

•WO (l,l)a(i. /STMTS ( 1 y 2 )-) # ( ASYA 3:b B 3 Y B 3 -I- G T M TS < 1 » 3. > YSTMTS < ,L y J. ) 
T2 * YAGYSTMTG (1 y I. ) i STM IS < J > 2 ) YS H-l FA ( 23) > 


(40 ( 2 y 1 ) ~STM l‘S C 5 y 3 > 

WO ( 3 y J. ) “S I'M TS ( S r .1. ) 

WO ( 1 y 2 ) “STMTS f 1. . I. ) T STMTS ( 2 1 2 ) 4 .2 , YA3 
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wn ( ? 9 • m .-stmts ? ) 
WO ( 5 » V . ) "'Tfi iT'-« CO 
Miu ■; ■ u n-irs, T-ro 


OF 


UOC 5 3>-=<U42*TMi. fAiJ|fflL+'r{t#Bl)- , .< i , 4Ct )/(bTM) tit 1/5) 
rS I rt'P - 4 3 * 4 ) *S I'M f Q < 4 . 5 ) - L» f MTS i 3 ? 5 > JcSTi I.TS < 4 r 4 ) * 

UP C 3 . 3 :■ -STM rs ( 8 > 3 ) 

wo ( i -i 4 j ~s j n rs c 2 ? r> 

WO < 2 9 A ) a a ♦ /STMTS ( A t 5 ) > £ < ( S T,M 1'S < 4 y 4 ) -i j . > $ v STMTS (. 5 » 5 ) 
43TMTS ( 4 y 4 ) j! ,-42**A14CJ. ) -S'lMTS< 4 » 4 ) «ST? iTS t 4vb) 


£ 

O - 

(X 

% 


4STM7S ( -i r'.j ) SSTMTS ( 3 j 4 ) -STMTS ( 5 » 5 ) -STM 17.? ( 4-y '1 > K2 , YA 1 Till 
+Al*Ai4Bi*Bl >- < S fri TS (3*5) /STM TS ( 4*5) ) 7 ( :l ; 44 * *rt t I- 
AJ 7A.‘l.-fMTD.l ) :•!< < 1 -> ±Cj ) / C STM TS ( 3-y g ) fSTjiTS < 3 1 4 '■> TSTHTO <4*5 > 


S -STM rs < 3 i 5 ) SSTMTS t '! t 4 >-) 
WU ( 3 y '1 ) ■--& RiTS C 0 y 4 > 

wo ( .1 > r; > -= stmts c 2 * 3 j 


wo < 2» 5 * rrn s < 5 » 5) i-stmts < 4 * 4 .) f j , 42 * *aj 1 ci 

W0<3«5)=STMTS<n*5) 

WOCi. v 6 ) ~ STMTS ( 2 « 4 ) 


WO < 2 y 6 ) - -STMTS ( 5 y 6 ) 

. WO 03 9 6 ) =■ ( 1 * 1 2 ♦ $ A 2 4 A 2 * A 24 F< 2 # B 2 ) * ( 1 > 4C2 ) / ( 3 I'M TS (6,0) 

■}. STMTS ( 4 y 7 ) SSTMTS ( 7 > 0 ) -STMTS ( 4 <■ 9 ) SSTMTS ( 7 . 7 ) ) 

WO ( t.) ? ) -'STMTS ( 2 7 7 ) 

WO < 2 y 7 ) -STMTS < b'v 7 ) 

WO ( 3'y 7 )■■=(!.* /S FMTS ( /' » 8 ) ) jcjC ( S )'M F-S ( 7 , 7 ) f J, . j jt ( S f MJS (8,0) 


!• STMT S3 7 >■ 7 ) + J- * 4 2 <■ * A24C2 ; -S )!M J'S i / y / J 4S TM 1"C ( 7 v 0 > 

42 - 
TA24A 


tS THIS < 7 y 0 ) -TO'HiTS ' By/) -STM I'S ( {>■• 0 ) • Si MTS i 7 y '/ 
4A24A ?4D2* f.s.2 ) - ( S TM1 H ( 6 * 8 > / OTriTS ( 7 ? u > ) J}. ( L , 4 2 


2 * ,V 


-r 02 TS 7 ) # i. !. * +02 ) / STM 1 S < 6j 0 ) J STMTS ( o , 7 
S 1 ill S ( 4 y 0 } 7S 1 1 S I S s ./ 7 ) * 
U0(ifl-*>=STMrSt2-»0> 


■S ( 7 v 0 ) 


WO ( 0 ) ■= STM ) S ( G ? 0 ) 

WO ( 3 y y ) «C 1‘MTS ( 0 y 8 740TMTS (7*7)4 i 4 2 , * A 7-; : 02 
CALL MIMVS'WI rh SET y LW , ilW j 


CAL L OMPR.fl <-W I r WO y 0 W y M / M - N ) 

C A L L G I s 1 P R D ( T HE 1 AC y GW y W 0 R I ' 7 j N y M y N ) 
CALL OMSUC < STM TS - W0RK7 ■■ WORKS * N y N ) 


TYPE. 503 

105 i"ORMA F < / VA ■> ' T* !E TEED BACK. COEFFICIEHTS- 

DO 501 T“i yM 


T YPE 50b y ( UW.( I y J )■ y J= 1 y N ) 
50 * TYPE 506 ' . 

505 FORMAT ( /4X y 1P4B25 < 16) 


507 


E OPM A I </4X y 'X' ) 

1 YPE 507 

FORMAT ( / 4'X y ' THE PH I-THETA#S MATR £ X • ) 


00 508 T --i y M 

508 TYPE .1 1 0 y ( WORKS ( I , J > 


J=i y N ) 
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CALL EXIT 

100 H)Rh'rtT</-4X-4HDIET.-? IPk'JL 2*9) 

V>1 1‘ONMnf (AlX«18HUGi'fiHnr!i3 MAI ft IX H.< 


10*; !• URMh T 4 A-JX • -IPHis IYj IT. i RANG F IjjLUi. HAIRLT FUR I'Oi i l' IN' iUuS SYSTEM » ’■ O.X j 

12HK»rl;M 

1 yft FARM A f </ 1/ y 46 HO f A fF i RAMS (. i i'ON MATR 1. X I- ili^ JiAnRi.r. On TO SYSTEM? Lu; 

j. ?2ilK- ^ jv,' 

JO-1 F0«hH‘i't/9X#2HPW) 

.1.05 EUfti iAV ( /'■■‘■X « ' ftiPlqXYTy i'YliY Y.jcYrYY LiricYYY-i'A • -M v *> ?l-i r - ? ES >2) 


I l GRHA T ; /-IX r 2HFU 5 

:J i 0 FORMA r ( 2X * 1 PS El 1,7) 

t 0 7 F Ufth'H f k / 4X v ' I'HIT A nn FR X X ) 


:! 00 
,1.09 
1 11 


FORMAT ( /'-IX? ' THU B MATR i’X ' ) 
FORMA r ( /A X y THE GO MATR IX") 
FORMA r ( /4X * • Till-: HO MATRIX ' > 


FORMAT fOXs (P5E19* i 2) 
iIN.1.1 

SI I Oft OUT XrtE t JHP RU ( A - P , ft - N y f 1 :>! . ) 


IMPLICIT RE Hi.. #8 ( A il?0~Z) 

.0 1 MENS r ON A < N »H ) y 0 < M * L ) y ft < ft ? I. > 
.00 1 X«i»N 


no i ,. 1 -j >i. 

ft (I ■■ J)=0, 
DO .1 K= 1 1 M 


ft 05 J) «R ( x ■ - J ) f A 1 1 t K ) SB c i ; •• J ) 
RETURN ' 


• END 

SUDROU'i 1 NE GrtMUL < A y B * ft j N y M ? L t 
I rlF'L 1 0 1 T 1 ilirtLSS ( A-l I ? L)- -Z ) 

0 1 HENS [ON h ( 1 ) * .8 ( i ) * R ( 1 ) 

IR~0 
JK« -M 

00 10 K - L ? L 
[K-CKfrt 
DO 1.0 J= .!. y H 
1R=IR*K 
J.i. -J -M 


TO -IK 
IKIR>-0 
DU .1.0 1 = 1 yM 
JX ! ~J.Li l N 

IB- IBM 

1 0 ft (' I ft ) =ft ( T R. ) + A t J I > D ( I U j 

RETURN . 

END 

SUBRUUT I NL* 0 MS UK ( A y B t ft » N y h ) 

1 HP LJ C T T REA I ,*S ( A-l-l * 0- 7 ) 

D [ MENS J fj N A ( N i H OD(M?HO ft < N j H ) 

DO i. [ = 1 y N 
DO :1. J=i y M 

1 R / 1 y J ) A ( I j. J < - B ( I , J) 

RETURN 


END 

suDftou r r ne ompso > a > d , c * n » m j 
MPL x c r r i n~: al* s c a ~h j u ~x ) 

u I M EM C . 1 0 N A < N r P - P ( M * M ) 

DO 1 1=1 yft 
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DO i J-j*M 
o c r j)"-a' r ^ .n#t: 

RF TURN 


ORIGINAL PAGE IS 


r ! v «. « 

i -i. Nil ^Hn UJJ s /*. f .U J i ! ” i * 

Wl IC'IT RKAK<«<iW^O -X' 


OF POOR QUALITY 

DIMCMS [UN A ( ‘1 ■ ii) .* BIN? fl ’’ s kuHn) 
DO 1' 1 -t N 

HO !. J=hri 

1 

R <1 ij) “--A (1 » J )+n ( T * J ) 

RETURN 

END 




SUUkOUT f ML 0 1 RMrt f ^ A? N , »' - PHI t THE I’fty K t 
XMPLiCI T REALMS < A--! ! .» 0~ 7. > 

D X MENS [ ON A < N » W > . PH !!' i N . N > .y I'Hf. T A ( hi ■■ 

HI 
N ' 

vH2; 

?W.I. CN^n > H2(NH'l) 

N2=N#M 
ALPHA™:!. -w 
PET a- J ,11-40 

C 

KHfiX-0000 

LIN-0 



0 

C 

C 

INITIALIZATION 



on u l ■■■■} i N 

IUj & xJ 1 * J. p M 
TFCt-.i) 1>P*1 

W I. t X >■ J i ~G . 

T! FETA < I » J ) •<; , 

v'-. 

80 TO 3 
PH t<3 y J)“i > 
U3 C I y J > ~T 



:? 

c 

fillirAi I»J).--T 
CONTINUE 



c 

J 4 ' 

NORM OF A 



l. 

TYPE 601. 



601 

600 

FORMAT (/4Xy ' f.HE PASSED A MAT R T\' ' '> 
no 6oo i*i ?n 

r 'i pi™ :- J o3 * t a ( j v j ) . js- 1 « n ) 



602 

TYPE 602 
FORMA 1 < 4X » *%* ) 
rtNORfe) --0 - 



no 4 I - :i y n 
no 4 J~1 i>N 

4 A N 0 R H “ A N 0 R i 1 ITU A 0 S ( A < X * J > ) 

C 

C 

K~2 

START OF LOOP 








13V 


0 


1 5 

Alv -K 

On! .!. GMPRD ( A ? W; , M 2 .. H „ N , h ; 

l c. •! 

Cni .L. Oh A Oil ( W2 - Pi j r * Pi ! i * N i v \ ) 
O'-T/AF. 
r OEM AT T 6 ) 

*~V j 

C ALi . GM P 0 0, ( U",? * W 1 rl's’NyNi 
CALL CM AD 0 U .! ;■ 1 HE r A * '! HE Th y N y N ) 
FORMAT ( 2X j 1 PC 111 4.7) 

51 

J F ( A K • A N 0 RM#T> 5 1 1 5 1 , ? 
LIN-1 
GO TO 5 

7 

.ONOK'M-O* 

DO & I~J. .N 
DO 0 J-i-vN 

o 

Bi>!ORM=«BMORM+ DADS ( W7 ( I , J > ) 

EPOL ON -ANORMYT / ( AKF2 < ) 

TF S T - D NOEM-'K A M 0 R N :R F ' ( \ AK H ♦ ) # < J » -EPSLON ) ) 

00 9 I=i#N 
HO V J="|. r N 

EF ( .DA Of; ( PH I < I ? J ) ) -BETA ) 9 « 9 , 1. 0 

LG 

52 

IF ( TEST-ALPHA*DABS.< PH t f T y J > ) >- V y 9 ? 52 
1 IN =2 


GO TO 5 

9 ' 

nr 

CONTINUE 

RETURN 

IF ( K'-KHAX ) 1 1 * 12 yVJ 

1 1 

K =Kv 1 

1.1 N-0 
GO TO 1.3 

12 

207 

1 YFE 100 yK 
TYPE 20 7 y LIN 

FORMA r ( 4X » y STATUS CS ' y T2 ) 

500 

TYPE 500 * A NORM . K 

FORMAT C / 4X y ' ANORM- ' 1 1 PE J. 4 TP K= ' y 15) 

RE TURN 

100 

FORMA T.C//20H K GREATER THAN KNA'Ty J 5/0 j 
END 

SUBROUTINE MIND ( A - N? By L y h ) 

C 

IMPL-TCJ f REhL-FO \ A -H y 0~ Z i 
DIMENSION A < 1 ) y L C D , M C 1 > 

C 

c 

SEARCH FOR LARGEST ELEMENT 

D : ".l. . 0 

NK“-N , 

DO SO K~l. * N 
HK-'NK f N 

L < K ) ~K 
H ( K > =K 
KK"“NK hl< 



tsICA-ACKIO 
DU ?0 .j'"!\ > N 

EI-N'SC j - I > 

tin so j:--Kvi\i 

u--.Tr-; x 

Xi-jAPJC.o:ruA j- ads; a an) ) us 

BIGA-ACXJ) 

L(K)=-T 

M C K )"..J 

CONTINUE 

INTERCHANGE ROMlI 

J=L C K ) 

XrCJ~[Q ~5 ' 35? .25 

KI'-K* -N 
DO 30 X ™ ! y M 

M---KITN • 

I ICU-iT- -ACM > 

J.T“KJ NKJ 

a c k i > •- a c -i ) 

AC JX ) -HOLD 

X NTHMHANOE COL i jNNO 

X «M C K ) 

Il'C I ~K> 15M5E39 

DO '!0 J~ I . ') N 

JK~-NKT J 

JIMP f.l 
HOLD--ACJK) 

ACJK> -~A C JX ) 

AMI) -HOLD 

tiTOI.DE COLLJHN BY MINUS 
CONTAINED 3N BIG A 3 

XFCBX6A) 4&,46*4ft 

P-0 < 0 
RETURN 

•DO 55 IM?N - • 

IFCI-IO 50 v PJ ? 50 
' L'K“NK‘-M 

A C IK ) "A C XK ) / C '-BXGA ) 

i CONTINUE 

REDUCE MATRIX 


DO A 5 3 ~ I. ? N 
XK-NK+X 


n 

i » 


1=32^ 


ORIGINAL PAGE IS 
OF POOR QUALITY 




’.33 


HOLD ---A UK) 
1J«J- N 

J- : U, v ill 




— ii'—.r.-S.JLi ______ 

T,;-= r j-f-N 

!F ( 1 -K j .vO >• 6 S ,\Ci 

•Li' .J‘ " K ) f'< 7 ’J S,'| v o'? 


0>V! 
«b U 

KJ--JJ K 

A C i J 5 -! |OLD#h ( K J ) f A < T j ) 
CON H Will- 

c- 

c 

c 


bio mi: row by pium 

KJ“K-N 
DO 70 J~'L?N 
KJ--KJ 5-N 


70 

“'O 

IFt J--K) 70 , 75 * 70 
A (KJ)-A (KJ) /BJOA 
CONTINUE 

c. 

C 

0 


PRODUCT UF PI OLD'S 

r 


.fl=OKB.TGA 

c 


PEP LACK PI OUT BY RECIPROCAL 

c 

SO 

A ( KK ) ~ 1 » 0/B IGA 
CUNT INUE 

c 

1 * 

r 


FINAL ROW firlD COLUMN IN fLRCHr-iNOE 


LOO 

K~N - 
K~ <K— 1 ) 

IFt K ) 150,150*105 


1.05 

100 

J.'~L<K>. 

IFCI-K) 120? 120»1 OS 
, !0 "NY ( K-J ) 

JR=N# f i - L ) 

DO 1.10 J~1 ) N 
JK ~JO-r J 

HOLD=rtC JK l • 
JT-JR-f J 
A < JK ) - -A(JI> 


110 
J 20 

A ( J I ) •“•HOLD 
IF(J-K') 100, 100? 125 


:!2S 

k:i>k~n 

HO 130 1-1 ,N 
kj: ~ki f-M 


i'3'o' 

150 

HOLD =A l KI ) ■ 
JI-KI -K-{ J 
A (KI j “--A ( JT ) 

A (17.0"' •=! 1 OLD "" 
00 TO LOO 
RETURN 


END 




Figure 7~1* Time response of x, T = 0.02 sec, with feedback gains given in Eq. (6-35) 
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7-3 Computer Simulation Results, T = 0.04 sec 

\ 

it is of interest to investigate if the sampling period can be increased 
and still be able to realize state feedback control to achieve the desired 
bandwidths for the three system components. The sampling period is now increased 
to 0.04 sec. The matrices $(T) and 8(T) for T = 0.04 sec are given as follows: 

ORIGINAL PAGE IS 
4> (0.04) = 0F POOR QUALITY 


9.995x10 _] 3.999xlO -2 
-2. 447x1 0~ 2 9. 995x1 0 - ^ 
-3.328xl0 -6 -3-33xl0" 8 
-2.496x10"** -3.33xl0“ 6 
-1.247xl0~ 2 -2.49x10"** 
3.328xl0 -6 3.328xl0 -8 
2.496xl0~** 3- 328x1 0~ 8 
1.247xl0" 2 2.496x10" 4 


0 -1.1 87x1 O' 8 

0 - 5 . 936 xlO ~ 5 

1 3- 999xl0~ 2 

0 9 . 999x1 o" 1 

0 -3.035xlO -5 
0 8.094xl0 ~ 9 

0 6.070xl0" 7 

0 3-035xlO _5 


-1 . 583x1 0 -8 0 I.l87xl0“ 6 1 . 583x1 0~ 8 
-I.l87x10“ 6 0 5-936xl0“ 5 I.l87xl0~ 8 
7.999x10“^ 0 8.094xl0 ~ 9 8.094x1 0 " ’ 
3- 999x1 0 -2 0 6 . 070 xl 0 -7 8.094xl0 _9 
9* 999x1 0~’ 0 3.035xlO -5 6.070xl0~ 7 
8.094x10 1 1 1 3 . 999xlO -2 7 . 999x10"** 
8.094x1 0~ 9 0 9.999x10"’ 3.999xl0~ 2 
8.094xl0 ~ 7 o-3.074xlo“ 5 9 . 999xl0 -1 


(7-2) 


4.658x10“*' 

2.374x10“** 

-2.374x10“** 

2. 329x1 o" 2 

1 . 1 87x1 0~ 2 

-1 .187x1 o" 2 

3.186x10 8 

1.61 8x1 0" 6 

-1 . 61 8x1 0 -6 

2.374x1 o"** 

1 . 21 4x1 0 _if 

- 1 . 214x1 0 _2i 

1 . 187xl0~ 2 

6.070x10" 3 

-6.070xl0' 3 

- 3 . 1 66xlO~ 8 

- 1 .61 8x10 -6 

1. 640x1 o" 6 

-2.374x10“** 

-1.21 4x1 o"** 

1 .230x10"** 

-7.1 87x1 0“ 2 

- 6 . 070 xl 0" 3 

6.l49xl0" 3 
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The desired eigenvalues of the closed-loop ASPS are set at: 
x : 


4* 2 


Zj , z 2 ~ 0.976901072005 + jO. 00225733531031 
z 3 = 0 . 000335^626270 
z^, z 5 = 0.0028068097799 + JO. 003939345 
z 6 = 0. 44932896411 72 

Zy , Zg = 0.8587194942988 + jO. 16334107966 


The feedback gains are determined and are tabulated as follows: 

g n = 3*81 788058946101 70xl0 2 

^2 


g ]2 = 6.85602831 14373904x10 
g ]3 = -1 .82288739740501 88x1 0 J 
g Tli = -2.5313721087607277x10 


14 

g ]5 = -8.7845436116937588x10 
s l6 = g 17 = 9 l8 = 0 


g = -7-44883284947041213x10" 
g 22 = -1 . 341 0796296921 878x1 0 3 


g 23 = 4.3570829799433742x10' 


g 2if = 6.0505099423975705x10 
9 25 

g 26 = 2.0185680288217810x10 
g 27 = 3-61341 177934641 26x1 0 5 
g 2 g = 1 . 0477885260603344x1 0 4 
9, 


’31 


9 32 ~ 0 


g 33 = 7-8128183443659252x10 


= 1.0849353874460890x10 


g 34 


' 9 35 « 3.7650182657481631x10 
g 6 = 2.0 185680341 725262x1 0 5 
g 37 = 3.613411 7389247105x10'* 


(7-4) 



1-40 


g 38 = 1 .04778851 8837771 3xl0 4 

The time responses of x(t), <j>^ (t) and ^(t) for T = 0.04 and the feedback 
gains as listed above are shown in Figs. 7~5» 7“6 and 7~7, respectively. 

7.4 Computer Simulation Results, T = 0.1 sec 

Since the on-board computer has a limited capacity and processing speed, 
it is important that the sampling period of the ASPS should be kept as large 
as possible. It is well known that in general large sampling periods are 
detrimental to the stability of digital control systems. in the preceeding 
sections we have shown the design of the feedback gains for the ASPS to realize 
the bandwidth requirements with sampling periods of 0.02 and 0.04 seconds, 
in this section we shall show that the ASPS can be operated with a sampling 
period as large as 0.1 second. 

For T = 0.1 second, the tj>(T) and 0(T) matrices are, 

<f>(0.1) = 


9. 969x1 0 _1 9.999 xI0 -2 0 

-7. 41 8x1 0 -6 

-2.473xIO -7 

0 

7. 41 8x1 0 ”^ 

2.473xlo" 7 

-6. 1 1 4xl0~ 2 9. 969 x1 0 _1 0 

-1. 483x10"** 

-7.4I8x10~ 6 

0 

1 .483x10"** 

7.418x10 -6 

-5. 199x10” 5 -1 .299x10 -6 1 

9. 999x10" 2 

4. 999x1 o“ 3 

0 

1 .264x1 0“ 7 

3.161x10" 9 

-1.559xlO~ 3 -5. 198 x1 O -5 0 

9. 999x1 0 _] 

9. 999xlo“ 2 

0 

3-792xl0“ 6 

1 .264x1 0" 7 

-3. 1 1 7x1 0~ 2 -1 . 559x1 0~ 3 0 

-7.58lxl0 -5 

9- 999x1 0"^ 

0 

7.581x10~ 5 

3. 792x1 o" 6 

5.1 99x1 O" 5 1. 299x1 O -6 0 

1 .264x10" 7 

3- 1 61x10“ 9 

1 

9* 999xlo” 2 

4. 999xio" 3 

1 • 559x1 0" 3 5. 1 98x1 0~ 5 0 

3.792xlO -6 

1. 264x1 0" 7 

0 

9. 999xlO _1 

9. 999x1 0~ 2 

3. 11 7x1 o" 2 l. 559x1 O -3 0 

7-58lxl0“ 5 

3-793xl0“ 6 

0 

-7.68Ix10" 5 

9.999xl0" ] 
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2.910xl0 -3 

1.484x10" 3 

-1 .484x10" 3 

5.818x10 -2 

2. 966x10“ 2 

-2. 966 x 10 " 2 

4. 947x10 -5 

2. 529x1 0 " 3 

-2. 529x1 0~ 3 

1.484xlo" 3 

— i± 

7.585x10 

-7.585xl0“' 4 

2 . 966 xlo " 2 

1.51 6x1 0 -2 

-1.51 6x1 o" 2 

-4.947xlo" 5 

- 2 . 529 x 1 0" 3 

2. 562x1 o" 3 

-1. 484x10" 3 

-7.585x10“^ 

7.685x10"^ 

- 2 . 966 x 10" 2 

-1.516x10" 2 

1 . 536 xl 0 -2 


Corresponding to the desired bandwidths of the three system components, 
the eigenvalues of the closed-loop digital ASPS are set at: 
x: z ]t z 2 = 0.9423049137666 + j 0.05448575545211 

4> 1 : z 3 = 2 . 06 xl 0~ 9 

4> 2 : z h , z s = 0.5790229524118 + j 0.2756322267541 

z 6 = 0.1353352832366 

Zy , Zg - 0.6570647872999 + jO. 4965162436514 

The feedback gains are determined and are tabulated as follows: 
g n = 356.54391190867254 
g ]9 = 673-937543782499 
g ] 3 - -2. 971 496035004556x1 0 5 
g u = -2.1 929182981 9381 71xl0 5 
g ]5 = -2. 16171 28726694806x1 0 4 

9 16 = 9 1 7 = g l8 = 0 
g 21 = -699*45360421649164 

g 22 = -1318.3208244459652 

g 23 = 7- 1024984043771 98x1 0 5 <7" 

g 2h = 5-2415343590564353x10 



1 45 


g nc = 5- 166946875801 3832x10^ 
g 26 = 1 -583711 1307008396x10 5 
g 27 = 8. 549709764964071 3x1 0 4 
g 28 = 7799.1724382365824 

9 31 = s 32 ' 0 

g 33 = 1 .2735706421 362781 xlO 5 
g 3h = 9- 3987551 465092623x10^ 
g 35 = 9265.0100115225987 
g 3fe = 1.58371 11 569386454x1 O 5 
g 37 = 8. 5497094066096! 54x10^ 
g 38 = 7799.1723174474365 

The time responses of x, d>^ and (f> 2 of the digital ASPS with T = 0.1 and 
the feedback gains in Eq. (7~7) are shown in Figs. 7~8, 7“9> and 7“ 1 0 , respectively. 
These time responses show that with the proper design, the digital ASPS carr 
operate with a relatively large sampling time without any difficulties. 
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VIM. QUANTIZATION EFFECTS IN THE DIGITAL ASPS 


8.1 Introduction 

In the preceding chapters the digital ASPS was designed through decoupling 
and pole-placement techniques, and the designed system was simulated, on the 
digital computer. It was shown that the bandwidth requirements were approxi- 
mately satisfied by digital feedback, and the computer simulation results 
showed that the responses of the x, <j)^ and dynamics were guite good. With 
proper design, the digital ASPS can operate with a relatively large sampling 
period of T =0.1 sec without any difficulty. 

In reality, because of the finite bit length used in a digital computer, 
the state-feedback gains designed for the decoupled digital ASPS must be 
quantized. It should also be noted that the quantization effect due to 
operations in the digital computer is not the same as that introduced by the 
A/D converter. 

In this chapter we shall investigate the effects of amplitude quantization 
in the digital ASPS with state feedback. In general, it is well-known that 
quantization can lead to two possible difficulties in system performance. 

One form of difficulty is sustained oscillations or instability due to amplitude 
quantization. The second type of performance degradation due to quantization 
is ?n the form of steady-state errors. 

Although closed-form analytical methods are available for the studies of 
sustained oscillations and steady-state error due to quantization in digital 
control systems, the complexity and high-order nature of the closed-loop 
digital ASPS precludes the effective use of these methods. The discrete 
describing function method can be applied to the study of sustained oscillations 
in digital control systems due to one quantizer. However, the closed-loop 
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digital ASPS has many A/D converters and many quantizers representing the 
digital computer operation of the feedback gains. The complexity of the 
system also does not allow an analytical solution to the steady-state error 
by the maximum-upper-bound method, treating all quantizers as noise sources. 

The method adopted in this chapter is computer simulation. It seems 
that considering all difficulties, computer simulation still resulted in 
useful 'conclusions to the problem of quantization. 

8.2 Quantization Considerations in the ASPS 

In a digital computer a real number is usually represented by two parts: 
the mantessa and the exponent. Figure 8-1 illustrates the floating-point 
representation of the number X by' an N-bit mantessa M and an exponent part. 
Thus, X can be expressed as 

X = M x 8 e (8-1) 

where M is the mantessa, B is the base number, 2 in general, and e is an 
integer which represents the order of the exponent. The N-bit floating-point 

J 

number M is generally scaled to be 

B _1 < M < 1 (8-2) 

and two’s complement arithmatic is used for denoting negative numbers. 

In numerical computation, amplitude quantization is introduced by the 

finite length of the mantessa. However, the truncation error introduced by 

the quantization effect is not a fixed value; it depends on the exponential 

scaling; i.e., it is proportional to B e . Therefore, if the bit length of 

— N 0 # 

the mantessa is N, the quantization level is 2 x B . The quantization of 
a given number should begin with the calculation of the mantessa M and the 
exponent e. The flow chart given in Fig. 8-2 shows how the quantization 
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operation is implemented. 


N bi ts 



Figure 8-1. Representation of a real number 


Table 8-1 shows the subroutine FUNCTION QT (X) which is used for the 
simulation of the 1 6— bit quantization of the feedback gains for the digital 
ASPS. 


Table 8-1 


FUNCTION 'GT-XX)- 

•' .. 

IF (X*WE* 0 ♦ ) GO TO .L ‘ 

GT=0 * 

RETURN 
AX-ABS (X) 

SIGN=AX/X 

IF ( AX™,! ♦ ) 2 ? 3 ji 4 

GT=X 

RETURN 

K--0 ' 

IF < AX'. GT. 1 0 . JKJK < K-i > ) GO TO 21 
K~K~1 ' 

GO TO, 22 
K»i - . 

IF TAX * LT + 10 ♦ ikJfiK ) GO TO 21 
K-Kfl 

go jo 42 

BX*AX/rO«*#K 

tV~<BX/H)+0.»w 

GT=S1'GN*FL0AT < IV) #H*10 * ##K 

RETURN 

END 


1 

3 

2 

22 
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RETURN 


Figure 8-2. Quantization operation. 
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8.3 Scaling Effects on the A/D Converters 

The block diagram of the closed- loop digital ASPS with state feedback 
is shown in Fig. 8~3- The digital computer which implements the digital 
controller is interfaced with the ASPS through the A/D and D/A converters. - 

The A/D converters serve as samp le-and-hold devices and quantizers 

because of their finite bit lengths. i'f the A/D converter has N' bits in 

the output and is biased with voltage V, then the full-scale input V volts 

-N 

will result in a digital number 1-2 , which when taken by the digital 

controller will be interpreted as V(l - 2 which is the quantized value of 
V. Therefore, the A/D converter, together with the necessary I/O port in 
the computer, can be considered as an A/D converter with normalized 1 volt 
bias, i.e., simply a quantizer. The functional block diagram is shown in 
Fig. 8-4. 

Since the steady-state error due to quantization is directly related to 
the quantization level, the accuracy in the responses of the ASPS will depend 
on the quantization of the A/D converters. The most straightforward method 
of increasing the accuracy of the system is to fncrease the bit length of 
the A/D converter. However, this is an expensive proposition, and the cost 
can be saved by making use of the scaling technique in the A/D converter. 

In the ASPS controller designed in the preceding chapters, the sensor 
gains were assumed to be unity. For example, if the error in the x component 
is X meter, we assume that the sensor sensed X volts, and the controller 
received Q^(X) as a number for data processing. Because of the quantization 
effect in the controller, the steady-state error will be confined to be within 
2 ^ meter, where N is the number of bits in the A/D output. In general, N can 
be 8 or 12 ( M = 12 is used here), and the error is apparently not satisfactory. 




Figure 8~3, Block diagram of the ASPS with the state-feedback digital controller and 
quant i zers . 


U1 

4 ^ 
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N-b i t 
output 


Figure 8-4. Block diagram of A/D conversion. 

if a sensor gain of 1000 is introduced before the samp 1 e-and-hold , as shown 

in Fig. 8-4, then the X meter error in the system will be sensed as 1000X 

-N 

mm. After the quantization, the error will be confined to be within 2 mm. 

The digital computer takes Q. n (l000X) as an input number, and performs a division 
by- 1000 to convert it back to the number 0^ (1000X) /1 000 = X which is of the 
appropriate dimension. Since there are reciprocal gain factors at both sides 
of the quantizer, as shown in Fig. 8-5, the transfer function between points 
A and- B as seen from the quantizer 0 is the same as that between points C '•and 
D. Therefore, the control scheme thus far designed will not be affected by 
the application of a sensor gain. 

For the eight state variables in the ASPS, it can be seen that the scaling 
factors for each of these variables will not be the same for best system 
performance. As a matter of fact, the sensor gain should not be too low so as 
to have larger quantization error. On the other hand, the sensor gain 
should not be too high so as to cause saturation in the system. 

In actual implementation it ?s suggested that the possible maximum error 
be sensed (with a certain sensor gain) as the bias voltage of the A/D converts 
and the quantized value be divided by that certain sensor gain before i.t Is 
stored in the certain memory location in the computer. All the feedback gains 
are retained to be the same as they are designed without the scaling factor. 
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Figure 8 - 5 . Block diagram showing the effect of scaling. 


8.4 Computer Simulation of the ASPS With Quantization - 

in this section the reponses of the digital closed-loop ASPS with 
quantization are obtained through computer simulation. The block diagram of 
the system is shown in Fig. 8 - 3 . The sampling period of the system was chosen 
to be 0.1 sec. The feedback gains of the system are tabulated in Eq. (7"7) 
and are not repeated here. Eight-bit and 12-bit A/D and D/A converters were 
used. Since the 16-bit word length used in the digital computer is longer 
than the bit length of the A/D and D/A converters, quantization should be 
considered when computing the control signals of the ASPS. This process is 
represented by the subroutine program listed in Table 8-2. 

Table 8-2 


C DATA. SAMPLING AND A/D CONVERSION 


& 

8 

S' 

% 

§ 

8 

S 


, 1 ~3* 


5653'6865234375E2&a<X) +6* 73934936523 337SE2*Q <XD0 
' —2 ^971 4966 015625E5&Q < PHI 1 IN ) ~ 2 * 1.929931 640625E5>ftQ ( P 

--2+ 16i712646484375E4&Q.( PHIl'DT ) 

02=~6 * 994476318359375E2*Q <X>-1 * 318359375E3JQ (XBOT ) 

. +7, 1025.085 15625E5*G (-PHI1IN ) iS * 241546 6 -4 0 6 2 5 E 5 t 0 < Pill 
+5 ♦166931 15234375E4*8 ( PHI IDT ) +1 * 58370972 6 5 6 2 5 E 5 * G 0 
- +8 ♦ 5496521 4S4375E4JKQ t PHI 2 ) +7 * 79922485351 5625E3*Q ( P 
03*1 . 2734985351 5625E5&Q ( PHI 1-IN ) T9 * 3988037i09370E4*£K 
■f 9 ♦ 2 6 4 9 8 4 -1 3 0 8 5 9 3 7 5 E 3 CK P H 1 1 D T ) + I * 583 7 0 9 7 2 6 5 6 2 5 E 5 * 0 
+8 ♦ 5496521 484375E4*Q < PHI 2 > +7 * 79922 405351 5625E3M (-P 


T) 

H II 


1) 
PHI 
1112 
PHI 
( PH 
HI 2 


) 


2 1 M > 
DT) 
1) 

12 TH 
DT) 


01 = 8 ( 01 ) 

02 = 0 ( 02 ) 

03=8(03) 


emaiNM- w«e» 

Of POOR QUAUTt 









FUNCTION Q (XX) 

C 0 M M 0 N X pXDOT y P H 1 1 y P H I J D T y PH 1 1 1 N p PH 12? P H 1 2 JO T y P H 1 2 1 N y T y 
S y 1 y 'v'2 y 03 y A J y AM I y AKSX y AKSP y AKSS p A33 y TPR T » RB , DELTA * 

% AO p BO p CO p DO p E p F ? TEND p H p 
S NPR T P j: V 1 » T02p 1 03 P L I NE 
IF<XX»LT »0*) 60 TQ 20 
J. V- ( XX/1T ) +0 ♦ 5 
60 TO • 30 

20 IV=<XX/H)~0*5 

30 Q -FLOAT C IV) #H ORIGINAL PAGE IS 

RETURN OF POOR QUALITY. 

END 


Figure 8-6 shows the responses of the x-dynamics of the ASPS with an 

Initial condition of 2x10 ^ for the first 60 seconds, with and without 

quantization. The A/D and D/A converters have 12 bits. Notice that the 

quantization effect on the transient response is to cause an overshoot in 

x at the beginning. Figure 8~7 illustrates the response of the x-dynamics 

beyond 100 seconds (near steady state). Notice that the response cannot be 

classified as “sustained oscillation", since it is not periodic. However, 

it does appear that the amplitude of the response has reached a maximum 

saturated level. in this case, the maximum error due to quantization is 

-12 

less than 1.5 times 2 

Figure 8-8 illustrates the response of the 4^-dynamics with the same 
quantization level as described above. In this. case it is seen that the 
quantization effect was to cause high overshoots in the transient response, 
but the response quickly reached a bounded steady-state. Figure 8-9 shows 
the same response beyond 1^0 seconds. We see that the maximum steady- 

-h 

state error due to the 12-bi - t quantization is less than 1.5x10 , Again, 

the steady-state response cannot be described as a sustained oscillation. 



1 58 


Response with quantization, 12 bits 


Response without quantization 



Figure 8-6. Responses of the x dynamics with and without 
quantization; 12-bit A/D and D/A converters 









Figure 8-10. Time response of d)^ dynamics with 12-bit 
A/D and D/A converters. 
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In a similar fashion the time response of the dynamics with- the 12- 
bit A/D and D/A converters in the ASPS system was obtained and plotted as 
shown in Fig. 8-10. Again, the steady-state error of 4 >^ due to quantization 
is very close to that of . 

Figure 8-11 illustrates the time response near- the steady sHate of 
x with 8-bit A/D and D/A converters. Figure 8-12 i 1 1 ustrates. the time 
response of <f>, under the same condition. In these cases, the steady-state 
errors due to quantization are all less than one quantization level, 2 
As expected, the steady-state error due to quantization is directly related 
to the quantization level. In general, large quanti zation levels will 
result in large steady-state errors. 
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IX. NONLINEAR SPRING EFFECTS ON THE DIGITAL ASPS 

9. 1 i ntroduction 

The analysis and design of the digital ASPS conducted in the preceding 
chapters were based on the system model that the spring characteristics of 
the wire-cable torque were linear. On the ASPS a wir.e cable is attached to 
the center of the payload mounting surface with the other end of the cable 
attached to the shuttle frame. Similarly, there is another cable attached 
between the pallet and the shuttle (see Figure 1-2.). 

For the linear analysis and design, the spring constant of the payload 
is designated by the constant K s (2 and x dynamics), and the spring constant 
of the and d>^ dynamics are designated by and K.^, respectively. 

The nonlinear spring characteristic of the wire-cable torque is shown in 
Fig. 9“1* The spring parameters are given by H^p and K s , as shown in the 
figure. The abscissa is shown as z, , but the same characteristics are assumed 
for x, 4>j and 4>'2’ 

The objective of this chapter is to investigate the effects of the non- 
linear spring characteristics on the performance of the digital ASPS with 
quantization. Since the overall ASPS with the nonlinear spring and quantizers 
is a high-order digital control system with multiple nonl i near i t ies , no 
analytical methods are available to conduct a closed-form study of the system. 
Thus, computer simulations are conducted for the studies. The listings of the 
simulation program are given in Table 9“1. 

9.2 Effects of the Nonlinear Spring on the X-Dynamlcs 

Since the nonlinear spring characteristic shown in Fig. 9-1 can be inter- 
preted as the superposition of a velocity-dependent force (or torque) to the 
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Table 9~1. Computer listings of Digital ASPS with V/ire-Cable 
Nonlinearity and Quantization. 


TYPE SI NOT , F 1 

DIMENSION PR? ST C 5 ) y Y ( G ) * DER Y ( 0 ? AUX ( 8 :• fj » 

EXTERNAL FCT y OUTP 

.COMMON X y X.D 0 T v P H-I i. y P H 1 1 D T y , P H I i. .TNyPHT2 ? PHI2DT y PHI2.1N t f t- 
a 0 L 9 02 •> 03 ? A J ? AMT y AX’S/, ? AKSP y AKSS y A33 y TPRT y RB y DELTA y 

5 AO y BO y CO ? .00 s E y F y TEND y H y 

6 NPRT ylOiy 102 » 103 t LINE 

OPEN I UN IT -6 /DEVICE * ' DSK ' y FILE™ ' F0R20 * DAT •’ y ACCESS® ' SPROUT ' > 


LINE-0 
TSP=0 * 3 
H-2»SS-12 
fEND-200 * 

FHRT»0*2 
TlNT»i.0E-2 - 

C — SET INITIAL CONDI TIG 

X •” •“ .!. ♦ 68 8 1" — 5 
X-DO-T- -5 , 302E-6 
PHIl*6.756E-7 
PHI I.DT=5 + 090E--7 
PHHMN=3T549E-7 
PH 1 2=1 * 774E-6 • 

PH I2DT =6 * 753E -6 
PHI2IN--i*ZUE- 
AM.i -COO ♦ 

AKGX - J *051 
AKSP-O* 0.05 
AKSS -0* 005 
A J~ 5 0 * 

A33 :=: 28G5< J.15‘ 

RB— 1 * 956 

AO-.RB 

BO-l./AMI 

C0-Aril*RB/A33 

By=-AJ/A33* 

r.— 1 * /'A , ; 3 

F-.i. * /A J 

DELTA- 1 v -VA.05KC0-B0 
T-9 * 7801 El. 

NPR T =0 

PRMT C 3 ) -TINT 
PRMT < 4 ) -0 * 01 $2 * l£ — 3 
DO 99 1*1,8 >’ 

99 DERYT I) -0*125 

NOIM-S 

10 r F t T * GE * TEND > CALL, ' EX I T 


ORIGINAL PAGfPSS 
OF POOR QUALITY 


C DA f A SAMPLING ‘AND A/D CONVERSION. 


GX- 100 
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GP1-50. 

GP2=50, 

9 L==3 >5653606523 f37UE2JR(.\»0K') i6*75^5 49\o3;'54}75E7* 

5 GCXDOTylyX} 

5 “2 * 97 .1. 4 V 6 6 01 5620! • 5*0 U-‘i 1 1 1 T N y GP l J. 729 93 1. 6 40o 2 5F! j* 

£ n<PIIIi*GPl) 

6 -2 , 1 6.1. >'i 2646484 375E «G CPI II IDT r 0P.1. )■ 

92 ~ -6 * 99 44 76 3 J 8359375E2#Q t X y GX"> -1. ,3 J S359375E3*Q < XDO I t OX > 
H +7 » .1. 021.5085 1 56251.15*0 i PH.T 1 IM» GP L ) 4-5 * 2 4 1 5 4 6 4 404 2 5 E 5* 

Sf - Q( PHI tv GPU " 

X f 5 * 1 669 31 1 5234375E4#U ( PHI 1 D T y GP I ) +1 ♦ 5/8 5 7 0 9 79 8 5 6 2 5E 5 * 

% R < PHI 2 IN f GP2 ) 

% +8 * 5496521 40437511451X1 CP Hi' 2 » GP2>-+7 > 7999240535.1 5625E3* 

H U ( PHX-2BT ■••OP. 2 ) 

93:=: i\ 7 7 54 9 8 5.3 5 1. 5625 i: 5 * R ( PHI 1 CM * GPl ) 4-9 „ 5 V 0 8 0 3 7 1. 0 9 3 75 E 4 * 

* QCPH'f :l yfiPJ ) 

& • +9 * 264904 1 30059575E34 U < PHI J. JOT » GPi ) + 1 * 5S470972o5625E5* 

-£ Q ( PH 12. CM ? GP2 ) 

£ -I- 8 ♦ 5 4 9 4 5 2 J. 4 0 4 3 7 3 E 4 * G < Pi 112 j- GP2 > +7 * 79922485351 5625E3* 

S . 0 ( PHJ2DT y GF'2) 


G9.I -1. /ADS (91) 
092=1 <VABS ( 92 )•• 
G93=I t /AfciS<93> 
91. a OX 91 *139.1. ) 

99 - QX-92 r G92 > 
93=0 i 93 v G93 ) 
PK'fil C .1 1 “T 
PRMT C 2 ) =T+ FSP 

Y < J. ) = X 

Y < 2 ) =x.oo r 

Y C 3 ) *PHtiIN 

Y < 4 5 -PHI 1 

•Y ( 5 ) ~PHTl.ii f 
Y(6)=PHI2IN 
Y (7) -PHI 2 

Y ( 8 ) “PNI7BT 


ORIGINAL PAGE IS 
OF POOR QUALTOf. 


.CALI. PEGS C PRMT y Y y BFRY y MDIM y IHLI-' y FL.I r UU I F 

GO' TO 10 

EMU 


SUBRQu i ,un ii i-uiuXjYj DERY ) • 

DIMENSION ' YC8) y.0ERY<8) 

COMMON X 9 XDOT y PHII » PHI I DT * PHI 1 IN i PMI2 >■ PH-I2DT y PHI 2 IN * 
£ 9.1 ? 92 9 93 9 AJy AM T f AKSX y AKSP ? AK8S ? A'33 r TPR T y RB y DELTA y 

a AO f BO s CO y-DO 9 E.r F » TEND r H r 
& NPRT r 191 9 T92 y JU3 y LINE 
HX=0. 00279; 

HPi=X) < 00.279 
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LOO 


200 


20 

30 


* 

& 


HP2-0 v 0027'? 
Xr-:Y(2) v LT , 0 » ) 
TFfY(5> .LT. 0. ) 

TF'YiS/ « LT.Ov ) 
PLEA (i ) ~ Y < ; ‘ > 

Ul- R ; < 2 ? H <~UIYBO 


HX-~ 

HPi* 

HP 2 : 


■HX 
-HP I 
--HP 2 


-AK8XYBO i Y < L 1 > -BOYHX > * ■ 


•I IP 1 > YE+ ( V3+hKSS* Y i 7 ) -f HP2 ) : 


DERY ( 3 ) == 
.uERY ( ■} ) ■- 
DERY ( 5 ; ~ 


DEKY(ol) 

DERY (7) -YCS). 
UERY <8V-( (-U3 


Y ( 4 ) • 

AH 

Y(3) ' . . 

: ( ( ~V2~MKSrrr' ( 4 J -HP I ) Y E 
f < U3Y AKSS *Y0 7 ) -H iP2 1 Y.OOYF 
Y (?) 


-HO ) TAU* ( ( -U2--AKSPY 
•YDO) )/ DELTA 


iX*Y C :L ) ■{• HX J *80*00 
) /DELTA 


-AKSSYY >. 7 ) -HP 2 ) YFY ( i ♦ -AO*CO ) + ( V2+ftKSP*Y i 4 ) +HP1 ) YE 


. -HU t + AKSX* Y < 1 > +HX ) *BO*CO ) /DEL f A 

RETURN 

END- 

SI IRRGUTINE OUTP ( XX y Y r DERY y IHLF , N DIN r PR NT ) 

D [ HENS [ ON Y < 8 ) y DERY < 8 ) y PRM T ( 5 ) 

COMMON X 9 XBOT p PH 1 1 ? PH 1 1 0 T y PH I i IN y PH E 2 t PH 1 2D T y PH 1 2 

V 1 7 U 2 y V3 )• A J ? AM I y AKBX ? AKSP y AKSS ? A33 . TPRT » RB y DELTA y 

AO y BO y CO y DO r E y F y TEND ? H y 

NPRT v I U i y I U 2 y I U3 y L I ME 

IF ( XX * GT ♦ TEND ) 'PRHT < 5 > ~1 * • 

If -XX 

I F ( X X ; L T t. TP R T *FLO A T ( N P R T ) ) 

L JNL-LINE-f 1 

WR I f E ( 6 ? 100) 1 1 ILF y XX y ( Y (I ) 

FORMAT ( 


IN 


y i y 


RETURN - 

■ T = I y 3 i y U I. y 02 

XX? IPEIO * /} , IPSEii ,3 * 2Xy i P2E1 1 „ 3 > 


y 1 2 y 

X-Y ( 1 ) 

XBOT -YY 2 ) 

PHU IN-Y (3) 

PHI J. ~Y ( 4 ) 

PHI IDT- Y' (5) 

PH. 1 2 IN-Y ( 6 > 

PHI2-Y (7) 

PHT2DT-Y (8 ) 

NPR r-NPRT+J. 

IF ( LINE * L7 ♦ 5 ) GO TO 200 
UR ITE(UyiOO) T HI F , XX » f Y f ! > y 
LINE-0 
RE TURN 
END 

FUNCTION Q < XX ? G ) 

COMMON X y XBOT ? PH1 1. ? PHI IDT? PHI I IN 9 PHI2 y PI II7DT 
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Figure g-l. Nonlinear spring characteristic for the 
wire-cable torque of the digital ASPS. 

linear characteristic of the ideal linear spring, it is expected that the 
gross effect is some damping effects on the system dynamics. The computer 
simulation results show that there are no sustained oscillations as a result 
of the nonlinear spring character i st i cs . 

Figure 9-2 shows the transient responses of the x-dynamics of the digital 
ASPS with feedback control as designed in the preceding chapters. A 12-bit 
quantization is used. The initial value of x is 2x10 ^ , and Hyp is varied 
from 0 to 0.008. Notice that when H = 0, the springs are ideal, and the 
response of x is oscillatory. The initial overshoot of the x-dynamics responses 
is due to the quantization effects. The final steady-state error of x when 
Hyp = 0 is small with a non-zero mean, but the response is relatively slow. 

As shown in Fiq. 9~2, when the value of H, ._ is increased, the time response 

Wr 

becomes faster in reaching its steady state. In fact, when Hyp = 0.0028, the 
response of x resembles that of a deadbeat response, and the steady-statfe is 
nearly zero. However, as the value of Hyp increases further, the steady- 
state error increases. When H. , r = 0.008, the steady-state error is very 
large, and the response"is also very slow.’ Thus, the transient responses in 
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Figure 3~2 clearly show that the nonlinear spring parameter Hyp can be used 
to improve the x-dynamic response if the value of Hyp can be controlled to 
some extent'. 


9-3 Effects of the Non! inear' Spri ng on the and (p^ Dynamics 

The computer simulation results show that the nonlinear spring has 
little effects on the responses of the <f>^ and <p^ dynamics. Since these two 
response components are relatively fast, the above-mentioned results were 
expected. However, different values of Hyp did give slight difference on the 
steady-state error of the responses. These error trajectories tend to have 
zero mean as expected due to the effect of the integral feedback In the system. 
Figures 9~3 and 9 “^ show: the transient responses of and 4>^ , respectively 
when Hyp = 0. Figures $-6 and 9~7 illustrate the steady-state responses 
of 4 >i and <f> 2 > respectively, as compared with the steady-state response of x 
shown in Figure 9 ~ 5 - 

Figures 9-8, 9 - 9 and 9~ 1 0 illustrate the time responses of x, and 
for Hyp - 0.001. .When Hyp = 0.0028 it was shown in Figure 9-2 that the x- 
component has a deadbeat response. However, this value of Hyp did not improve 
the $1 and d > 2 responses, as shown in Figures 9“11 and 9~12. 

The conclusions on the investigations in this chapter is that the 
nonlinear spring effect due to the wire-cables on the ASPS does not appreciably 
harm the responses of the system. Except for the steady-state error when 


the value of Hyp is large, the transient responses are not much affected, 
There would be no sustained oscillations generated due to the nonlinear 


spring characteristic. 
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Figure 9-4. Transient response of <j> 
dynamics with H.._ = 0. 
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